[发明专利]一种基于球面电容的球面铰链运动方位测量方法

说明书

技术领域

本发明属于测量技术领域，具体涉及一种基于球面电容的球面铰链运动方位测量方法。

背景技术

随着现代工业的快速发展，球面铰链具有转动灵活、能实现空间机构运动和力的传递等特点，广泛应用于机器人、坐标测量机、电子机械设备、医疗仪器设备、汽车零部件等领域。球面铰链作为系统传动中的关键部件，其运动空间角度的测量有利于系统传动的反馈控制和补偿，对提高系统的传动精度和整机的工作性能具有重要的意义。

球面铰链运动是一种典型的多自由度运动。相比单自由度位移测量，多自由度位移测量难度较大，技术还不成熟，国内外的部分学者开展了相关的研究。国外，美国佐治亚理工学院Kok-Meng Lee等先后提出了用光学旋转编码器获得变磁阻型球形电机转子运动位置的接触式测量方法和利用视觉传感器、双光学传感器等非接触式测量方法来获取球形转子位置。专利CN1643343A中提出用于测量一个球窝接头的旋转和倾翻角度的装置，基于磁光效应，该装置通过在铰接球中布置磁铁，随着球头在球窝中位置的变化其磁场强度也发生变化，反映在磁光板上，被光学检测装置接受，进行相应的图像处理，获得球窝接头的旋转和倾翻角度。国内，北京航空航天大学寇金桥等开展了三自由度球形电机位置测量研究，利用二自由度光学传感器测量球电机三自由度位移的测量原理，提出了传感器的安装和位移计算方法。合肥工业大学李姜姜等开展了关于基于机器视觉的永磁球形电动机位置检测方法的相关研究。

这些检测方法所要构建系统比较复杂，在实际应用中受到安装空间和工作环境等限制，并且要投入较大的成本，研究方案有明显的局限性。

发明内容

本发明的目的是针对现有技术的不足，提供一种基于球面电容的球面铰链运动方位测量方法，基于球冠形电容极板间的面积变化引起输出电容变化的原理，以实现球面铰链运动方位测量为目标，通过球面电容电极的布置，对球面铰链运动的三个自由度进行解耦和求解。

本发明所采用的技术方案是：

在球面铰链的球头底部布置第一球冠形传感电容电极，球窝底部布置第二球冠形电容电极；第一球冠形传感电容电极和第二球冠形电容电极的大小相同；在球头的赤道圆周上均匀布置2n个第三球冠形电容电极，球窝的赤道圆周上布置2n个第四球冠形电容电极，n为正整数；第三球冠形电容电极、第四球冠形电容电极的球冠对应圆心角均为θ₀；其中，两个相邻第四球冠形电容电极中心间对应的圆心角为1.5θ₀，另两个相邻第四球冠形电容电极中心间对应的圆心角为2.5θ₀，其余每两个相邻第四球冠形电容电极中心间对应的圆心角为2θ₀；在球窝紧贴第二球冠形电容电极的顶部圆周处均匀布置四个弧形传感电容电极，第二球冠形电容电极与四个弧形传感电容电极均相互绝缘；将绝对式旋转编码器的码盘固定在球面铰链的输出杆上。

第一球冠形传感电容电极和所有的第四球冠形电容电极均加载电压V_INPUT；四个弧形传感电容电极均加载电压V′_INPUT；第二球冠形电容电极和所有的第三球冠形电容电极均加载电压0。

球面铰链运动具有三个自由度，可表示为球面铰链的输出杆与竖直轴正向的夹角ψ、输出杆在水平面上的投影与水平轴正向的夹角θ和输出杆绕自身轴线的转角；其中绝对式旋转编码器能测出输出杆绕自身轴线的转角。

当输出杆倾斜时，第一球冠形传感电容电极和第二球冠形电容电极间的有效重叠面积改变，导致其电容值变化，可以解得输出杆和竖直轴正向的夹角ψ。

对所有的第四球冠形电容电极分别编号，依次为1,2,...,2n；当输出杆倾斜时，球头赤道面和球窝赤道面始终有两个交点，其对应编号为N和N+n的第四球冠形电容电极检测到最大的电容值，则输出杆在水平面上的投影与水平轴正向的夹角θ＝(N-1)×2θ₀+Δθ+k×180°。其中，1≤N≤n，Δθ表示球头和球窝的赤道面交点偏离编号N的第四球冠形电容电极中心的角度，其值由编号N和编号N+n的第四球冠形电容电极与对应的第三球冠形电容电极间的电容值求出。k＝0或1，可根据检测到电容值不为零的弧形传感电容电极所在的位置编号判断出k的取值，从而确定θ的值。

本发明的有益效果是：

1、根据球冠形电容极板间的面积变化引起输出电容变化的原理，结合绝对式旋转编码器使用，实现球面铰链运动方位的非接触式检测。

2、采用绝对式旋转编码器直接测量球面铰链的输出杆绕自身轴线的转角大小，能获得较高的测量精度。