一种基于球面电容的球面铰链运动方位测量方法
【专利摘要】本发明公开了一种基于球面电容的球面铰链运动方位测量方法。现有球面铰链自由度检测方法所要构建系统复杂，相关技术还不成熟。本发明的绝对式旋转编码器测出输出杆绕自身轴线的转角；根据球头底部的第一球冠形传感电容电极和球窝底部的第二球冠形电容电极间的有效重叠面积解得输出杆和竖直轴正向的夹角；根据具有最大电容值的第四球冠形电容电极及其与对应的第三球冠形电容电极间的电容值变化、电容值不为零的弧形传感电容电极的编号，求解输出杆在水平面上的投影与水平轴正向的夹角。本发明基于球冠形电容极板间的面积变化引起输出电容变化的原理，对球面铰链运动的三个自由度进行求解，算法简单。
【专利说明】一种基于球面电容的球面铰链运动方位测量方法
【技术领域】
[0001]本发明属于测量【技术领域】，具体涉及一种基于球面电容的球面铰链运动方位测量方法。
【背景技术】
[0002]随着现代工业的快速发展，球面铰链具有转动灵活、能实现空间机构运动和力的传递等特点，广泛应用于机器人、坐标测量机、电子机械设备、医疗仪器设备、汽车零部件等领域。球面铰链作为系统传动中的关键部件，其运动空间角度的测量有利于系统传动的反馈控制和补偿，对提高系统的传动精度和整机的工作性能具有重要的意义。
[0003]球面铰链运动是一种典型的多自由度运动。相比单自由度位移测量，多自由度位移测量难度较大，技术还不成熟，国内外的部分学者开展了相关的研究。国外，美国佐治亚理工学院Kok-Meng Lee等先后提出了用光学旋转编码器获得变磁阻型球形电机转子运动位置的接触式测量方法和利用视觉传感器、双光学传感器等非接触式测量方法来获取球形转子位置。专利CN1643343A中提出用于测量一个球窝接头的旋转和倾翻角度的装置，基于磁光效应，该装置通过在铰接球中布置磁铁，随着球头在球窝中位置的变化其磁场强度也发生变化，反映在磁光板上，被光学检测装置接受，进行相应的图像处理，获得球窝接头的旋转和倾翻角度。国内，北京航空航天大学寇金桥等开展了三自由度球形电机位置测量研究，利用二自由度光学传感器测量球电机三自由度位移的测量原理，提出了传感器的安装和位移计算方法。合肥工业大学李姜姜等开展了关于基于机器视觉的永磁球形电动机位置检测方法的相关研究。
[0004]这些检测方法所要构建系统比较复杂，在实际应用中受到安装空间和工作环境等限制，并且要投入较大的成本，研究方案有明显的局限性。
【发明内容】
[0005]本发明的目的是针对现有技术的不足，提供一种基于球面电容的球面铰链运动方位测量方法，基于球冠形电容极板间的面积变化引起输出电容变化的原理，以实现球面铰链运动方位测量为目标，通过球面电容电极的布置，对球面铰链运动的三个自由度进行解耦和求解。
[0006]本发明所采用的技术方案是:
[0007]在球面铰链的球头底部布置第一球冠形传感电容电极，球窝底部布置第二球冠形电容电极；第一球冠形传感电容电极和第二球冠形电容电极的大小相同；在球头的赤道圆周上均匀布置2η个第三球冠形电容电极，球窝的赤道圆周上布置2η个第四球冠形电容电极，η为正整数；第三球冠形电容电极、第四球冠形电容电极的球冠对应圆心角均为Θ ^ ;其中，两个相邻第四球冠形电容电极中心间对应的圆心角为1.5 Qtl，另两个相邻第四球冠形电容电极中心间对应的圆心角为2.5 Θ ^，其余每两个相邻第四球冠形电容电极中心间对应的圆心角为2 Θ ^ ;在球窝紧贴第二球冠形电容电极的顶部圆周处均匀布置四个弧形传感电容电极，第二球冠形电容电极与四个弧形传感电容电极均相互绝缘；将绝对式旋转编码器的码盘固定在球面铰链的输出杆上。
[0008]第一球冠形传感电容电极和所有的第四球冠形电容电极均加载电压Vinput;四个弧形传感电容电极均加载电压V input ;第二球冠形电容电极和所有的第三球冠形电容电极均加载电压O。
[0009]球面铰链运动具有三个自由度，可表示为球面铰链的输出杆与竖直轴正向的夹角ψ、输出杆在水平面上的投影与水平轴正向的夹角θ和输出杆绕自身轴线的转角φ ;其中绝对式旋转编码器能测出输出杆绕自身轴线的转角Φ。
[0010]当输出杆倾斜时，第一球冠形传感电容电极和第二球冠形电容电极间的有效重叠面积改变，导致其电容值变化，可以解得输出杆和竖直轴正向的夹角Ψ。
[0011]对所有的第四球冠形电容电极分别编号，依次为1，2，...，2η;当输出杆倾斜时，球头赤道面和球窝赤道面始终有两个交点，其对应编号为N和Ν+η的第四球冠形电容电极检测到最大的电容值，则输出杆在水平面上的投影与水平轴正向的夹角Θ =(N-1) Χ2 θ 0+Δ Θ +kX180°。其中，I彡N彡η，Λ Θ表示球头和球窝的赤道面交点偏离编号N的第四球冠形电容电极中心的角度，其值由编号N和编号Ν+η的第四球冠形电容电极与对应的第三球冠形电容电极间的电容值求出。k = O或I，可根据检测到电容值不为零的弧形传感电容电极所在的位置编号判断出k的取值，从而确定Θ的值。
[0012]本发明的有益效果是:
[0013]1、根据球冠形电容极板间的面积变化引起输出电容变化的原理，结合绝对式旋转编码器使用，实现球面铰链运动方位的非接触式检测。
[0014]2、采用绝对式旋转编码器直接测量球面铰链的输出杆绕自身轴线的转角大小，能获得较高的测量精度。
[0015]3、适合球面副连接构件的角度测量，对测量装置的安装空间要求降低，结构紧凑，算法简单。
【专利附图】
【附图说明】
[0016]图1为本发明使用的装置中各零件的结构立体图；
[0017]图2为本发明中第一球冠形传感电容电极、第二球冠形电容电极及弧形传感电容电极的分布示意图；
[0018]图3为本发明中第三球冠形电容电极及第四球冠形电容电极的分布示意图；
[0019]图4为本发明中球窝底部的俯视示意图；
[0020]图5为球面铰链的三自由度运动分析示意图；
[0021]图6为本发明中第一球冠形传感电容电极与第二球冠形电容电极的重叠面积计算分析示意图。
【具体实施方式】
[0022]如图1和2所示，一种基于球面电容的球面铰链运动方位测量方法，在球面铰链的球头Ql的底部布置第一球冠形传感电容电极El,在球窝Q2的底部设置第二球冠形电容电极E2 ;第一球冠形传感电容电极E1、第二球冠形电容电极E2的球冠中心与边缘间对应的圆心角均为α =60°。由于球面铰链的结构限制，所要测量的输出杆与ζ轴正向的夹角Ψ取值范围一般不超过60°，因此第一球冠形传感电容电极和第二球冠形电容电极的有效检测面积足够大，可以满足测量要求。
[0023]如图3所示，在球面铰链的球头赤道圆周上均匀布置三十个第三球冠形电容电极，球面铰链的球窝赤道圆周上布置三十个第四球冠形电容电极；第三球冠形电容电极、第四球冠形电容电极的球冠对应圆心角均为9。= 6°，每两个相邻第三球冠形电容电极中心间对应的圆心角均为2 Θ ^ = 12° ;编号15与编号16的第四球冠形电容电极中心间对应的圆心角为1.5 Θ ^ = 9°，编号I与编号30的第四球冠形电容电极中心间对应的圆心角为
2.5 Θ ^ = 15° ,编号I至15、编号16至30的第四球冠形电容电极中，每两个第四球冠形电容电极中心间对应的圆心角为12°，保证了球头在球窝中转动到任意位置时均能输出电容信号。
[0024]如图1、2和4所示，在球窝紧贴第二球冠形电容电极的顶部圆周处均匀布置四个弧形传感电容电极Hl、Η2、Η3和Η4，第二球冠形电容电极与四个弧形传感电容电极均相互绝缘。弧形传感电容电极在平行球窝赤道面、垂直球窝赤道面的方向上对应圆心角均为S=6°，每两个相邻弧形传感电容电极中心间对应的圆心角均为90° ;将绝对式旋转编码器Q3的码盘固定在球面铰链的输出杆上。
[0025]如图5所示，球面铰链运动具有三个自由度，可表示为球面铰链的输出杆与ζ轴正向的夹角V、输出杆在xoy平面上的投影与X轴正向的夹角Θ和输出杆绕自身轴线的转角f ;其中，绝对式旋转编码器能测出输出杆绕自身轴线旋转角度《P。
[0026]如图2和5所示，当输出杆倾斜时，第一球冠形传感电容电极El和第二球冠形电容电极E2的有效重叠面积改变，导致其电容值变化，可以解得输出杆与ζ轴正向的夹角Ψ。
[0027]如图6所示，建立第一球冠形传感电容电极和第二球冠形电容电极的重叠面积数学模型，第一球冠形传感电容电极和第二球冠形电容电极的球冠中心与边缘间对应的圆心角分别为\和Ci2，球头的半径为R，可得:
[0028]曲线θι的方程:
X2 + V2 =(Rsina1)2f ,
[0029]\ 31(I)
Z = Rcosa1
[0030]曲线e2的方程:
Jx2 + (y + R cosa, sin ψ)2 / cos2 ψ = (R sin a, )2
[0031]i,",(2)
[x +(z + R cosa, cosvi/)" / sin vj/ = (Rsina2)"
[0032]曲线ei和曲线e2在球面上的存在交点Pp P2，其中P1的坐标为:
"xj" R / sin v|/^(sin a, sin ψ): - (cosa, cos ψ - cosa2)2
[0033]P1= y, = -Rzsinxiz(CosaiCos--Cosa2)(3)
Z1 R cos at
[0034]交点P2和P1关于yoz平面对称，因此，P2的坐标为:
[0035]P2 = [x2 y2 z2]T = [-X1 Y1 zjT (4)
[0036]通过球心O和交点Pp P2的平面OP1P2将两个球冠的重叠面积S分成两个部分S1和S2，令平面OP1P2和平面XOZ的夹角为β，则平面OP1P2和球面的交线e3的方程为:
【权利要求】
1.一种基于球面电容的球面铰链运动方位测量方法，其特征在于: 在球面铰链的球头底部布置第一球冠形传感电容电极，球窝底部布置第二球冠形电容电极；第一球冠形传感电容电极和第二球冠形电容电极的大小相同；在球头的赤道圆周上均匀布置2η个第三球冠形电容电极，球窝的赤道圆周上布置2η个第四球冠形电容电极，η为正整数；第三球冠形电容电极、第四球冠形电容电极的球冠对应圆心角均为Θ ^ ;其中，两个相邻第四球冠形电容电极中心间对应的圆心角为1.5 Qtl，另两个相邻第四球冠形电容电极中心间对应的圆心角为2.5 Θ C1，其余每两个相邻第四球冠形电容电极中心间对应的圆心角为2 Θ ^ ;在球窝紧贴第二球冠形电容电极的顶部圆周处均匀布置四个弧形传感电容电极，第二球冠形电容电极与四个弧形传感电容电极均相互绝缘；将绝对式旋转编码器的码盘固定在球面铰链的输出杆上； 第一球冠形传感电容电极和所有的第四球冠形电容电极均加载电压Vinput;四个弧形传感电容电极均加载电压V INPUT ;第二球冠形电容电极和所有的第三球冠形电容电极均加载电压O ; 球面铰链运动具有三个自由度，可表示为球面铰链的输出杆与竖直轴正向的夹角Ψ、输出杆在水平面上的投影与水平轴正向的夹角θ和输出杆绕自身轴线的转角φ;其中绝对式旋转编码器能测出输出杆绕自身轴线的转角φ ； 当输出杆倾斜时，第一球冠形传感电容电极和第二球冠形电容电极间的有效重叠面积改变，导致其电容值变化，可以解得输出杆和竖直轴正向的夹角ψ ； 对所有的第四球冠形电容电极分别编号，依次为1，2，...，2η;当输出杆倾斜时，球头赤道面和球窝赤道面始终有两个交点，其对应编号为N和Ν+η的第四球冠形电容电极检测到最大的电容值，则输出杆在水平面上的投影与水平轴正向的夹角Θ =(N-1) Χ2 Θ0+Δ Θ +kX180° ;其中，I彡N彡η，Δ Θ表示球头和球窝的赤道面交点偏离编号N的第四球冠形电容电极中心的角度，其值由编号N和编号Ν+η的第四球冠形电容电极与对应的第三球冠形电容电极间的电容值求出；k = O或1，可根据检测到电容值不为零的弧形传感电容电极所在的位置编号判断出k的取值，从而确定Θ的值。
【文档编号】G01P13/02GK104132675SQ201410334068
【公开日】2014年11月5日 申请日期:2014年7月14日 优先权日:2014年7月14日
【发明者】王文, 张敏, 卢科青, 范宗尉, 袁科杰, 诸丽燕 申请人:杭州电子科技大学