首页 > 专利 > 杭州电子科技大学 > 一种基于球面电容的球面铰链运动方位测量方法专利详情

一种基于球面电容的球面铰链运动方位测量方法   0    0

有效专利 查看PDF
专利申请流程有哪些步骤?
专利申请流程图
申请
申请号:指国家知识产权局受理一件专利申请时给予该专利申请的一个标示号码。唯一性原则。
申请日:提出专利申请之日。
2014-07-14
申请公布
申请公布指发明专利申请经初步审查合格后,自申请日(或优先权日)起18个月期满时的公布或根据申请人的请求提前进行的公布。
申请公布号:专利申请过程中,在尚未取得专利授权之前,国家专利局《专利公报》公开专利时的编号。
申请公布日:申请公开的日期,即在专利公报上予以公开的日期。
2014-12-10
授权
授权指对发明专利申请经实质审查没有发现驳回理由,授予发明专利权;或对实用新型或外观设计专利申请经初步审查没有发现驳回理由,授予实用新型专利权或外观设计专利权。
2016-05-18
预估到期
发明专利权的期限为二十年,实用新型专利权期限为十年,外观设计专利权期限为十五年,均自申请日起计算。专利届满后法律终止保护。
2034-07-14
基本信息
有效性 有效专利 专利类型 发明专利
申请号 CN201410334068.3 申请日 2014-07-14
公开/公告号 CN104132675B 公开/公告日 2016-05-18
授权日 2016-05-18 预估到期日 2034-07-14
申请年 2014年 公开/公告年 2016年
缴费截止日
分类号 G01D5/24G06F19/00G01P13/02 主分类号 G01D5/24
是否联合申请 独立申请 文献类型号 B
独权数量 1 从权数量 0
权利要求数量 1 非专利引证数量 0
引用专利数量 0 被引证专利数量 0
非专利引证
引用专利 被引证专利
专利权维持 4 专利申请国编码 CN
专利事件 事务标签 公开、实质审查、授权
申请人信息
申请人 第一申请人
专利权人 杭州电子科技大学 当前专利权人 杭州电子科技大学
发明人 王文、张敏、卢科青、范宗尉、袁科杰、诸丽燕 第一发明人 王文
地址 浙江省杭州市下沙高教园区2号大街 邮编
申请人数量 1 发明人数量 6
申请人所在省 浙江省 申请人所在市 浙江省杭州市
代理人信息
代理机构
专利代理机构是经省专利管理局审核,国家知识产权局批准设立,可以接受委托人的委托,在委托权限范围内以委托人的名义办理专利申请或其他专利事务的服务机构。
杭州君度专利代理事务所 代理人
专利代理师是代理他人进行专利申请和办理其他专利事务,取得一定资格的人。
杜军
摘要
本发明公开了一种基于球面电容的球面铰链运动方位测量方法。现有球面铰链自由度检测方法所要构建系统复杂,相关技术还不成熟。本发明的绝对式旋转编码器测出输出杆绕自身轴线的转角;根据球头底部的第一球冠形传感电容电极和球窝底部的第二球冠形电容电极间的有效重叠面积解得输出杆和竖直轴正向的夹角;根据具有最大电容值的第四球冠形电容电极及其与对应的第三球冠形电容电极间的电容值变化、电容值不为零的弧形传感电容电极的编号,求解输出杆在水平面上的投影与水平轴正向的夹角。本发明基于球冠形电容极板间的面积变化引起输出电容变化的原理,对球面铰链运动的三个自由度进行求解,算法简单。
  • 摘要附图
    一种基于球面电容的球面铰链运动方位测量方法
  • 说明书附图:图1
    一种基于球面电容的球面铰链运动方位测量方法
  • 说明书附图:图2
    一种基于球面电容的球面铰链运动方位测量方法
  • 说明书附图:图3
    一种基于球面电容的球面铰链运动方位测量方法
  • 说明书附图:图4
    一种基于球面电容的球面铰链运动方位测量方法
  • 说明书附图:图5
    一种基于球面电容的球面铰链运动方位测量方法
  • 说明书附图:图6
    一种基于球面电容的球面铰链运动方位测量方法
法律状态
序号 法律状态公告日 法律状态 法律状态信息
1 2016-05-18 授权
2 2014-12-10 实质审查的生效 IPC(主分类): G01D 5/24 专利申请号: 201410334068.3 申请日: 2014.07.14
3 2014-11-05 公开
权利要求
权利要求书是申请文件最核心的部分,是申请人向国家申请保护他的发明创造及划定保护范围的文件。
1.一种基于球面电容的球面铰链运动方位测量方法,其特征在于:
在球面铰链的球头底部布置第一球冠形传感电容电极,球窝底部布置第二球冠形电容电极;第一球冠形传感电容电极和第二球冠形电容电极的大小相同;在球头的赤道圆周上均匀布置2n个第三球冠形电容电极,球窝的赤道圆周上布置2n个第四球冠形电容电极,n为正整数;第三球冠形电容电极、第四球冠形电容电极的球冠对应圆心角均为θ0;其中,两个相邻第四球冠形电容电极中心间对应的圆心角为1.5θ0,另两个相邻第四球冠形电容电极中心间对应的圆心角为2.5θ0,其余每两个相邻第四球冠形电容电极中心间对应的圆心角为2θ0;在球窝紧贴第二球冠形电容电极的顶部圆周处均匀布置四个弧形传感电容电极,第二球冠形电容电极与四个弧形传感电容电极均相互绝缘;将绝对式旋转编码器的码盘固定在球面铰链的输出杆上;
第一球冠形传感电容电极和所有的第四球冠形电容电极均加载电压VINPUT;四个弧形传感电容电极均加载电压V′INPUT;第二球冠形电容电极和所有的第三球冠形电容电极均加载电压0;
球面铰链运动具有三个自由度,分别表示为球面铰链的输出杆与竖直轴正向的夹角ψ、输出杆在水平面上的投影与水平轴正向的夹角θ和输出杆绕自身轴线的转角 其中绝对式旋转编码器能测出输出杆绕自身轴线的转角
当输出杆倾斜时,第一球冠形传感电容电极和第二球冠形电容电极间的有效重叠面积改变,导致其电容值变化,可以解得输出杆和竖直轴正向的夹角ψ;
对所有的第四球冠形电容电极分别编号,依次为1,2,...,2n;当输出杆倾斜时,球头赤道面和球窝赤道面始终有两个交点,其对应编号为N和N+n的第四球冠形电容电极检测到最大的电容值,则输出杆在水平面上的投影与水平轴正向的夹角θ=(N-1)×2θ0+Δθ+k×
180°;其中,1≤N≤n,Δθ表示球头和球窝的赤道面交点偏离编号N的第四球冠形电容电极中心的角度,其值由编号N和编号N+n的第四球冠形电容电极与对应的第三球冠形电容电极间的电容值求出;k=0或1,根据检测到电容值不为零的弧形传感电容电极所在的位置编号判断出k的取值,从而确定θ的值。
说明书

技术领域

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

背景技术

[0002] 随着现代工业的快速发展,球面铰链具有转动灵活、能实现空间机构运动和力的传递等特点,广泛应用于机器人、坐标测量机、电子机械设备、医疗仪器设备、汽车零部件等领域。球面铰链作为系统传动中的关键部件,其运动空间角度的测量有利于系统传动的反馈控制和补偿,对提高系统的传动精度和整机的工作性能具有重要的意义。
[0003] 球面铰链运动是一种典型的多自由度运动。相比单自由度位移测量,多自由度位移测量难度较大,技术还不成熟,国内外的部分学者开展了相关的研究。国外,美国佐治亚理工学院Kok-Meng Lee等先后提出了用光学旋转编码器获得变磁阻型球形电机转子运动位置的接触式测量方法和利用视觉传感器、双光学传感器等非接触式测量方法来获取球形转子位置。专利CN1643343A中提出用于测量一个球窝接头的旋转和倾翻角度的装置,基于磁光效应,该装置通过在铰接球中布置磁铁,随着球头在球窝中位置的变化其磁场强度也发生变化,反映在磁光板上,被光学检测装置接受,进行相应的图像处理,获得球窝接头的旋转和倾翻角度。国内,北京航空航天大学寇金桥等开展了三自由度球形电机位置测量研究,利用二自由度光学传感器测量球电机三自由度位移的测量原理,提出了传感器的安装和位移计算方法。合肥工业大学李姜姜等开展了关于基于机器视觉的永磁球形电动机位置检测方法的相关研究。
[0004] 这些检测方法所要构建系统比较复杂,在实际应用中受到安装空间和工作环境等限制,并且要投入较大的成本,研究方案有明显的局限性。

发明内容

[0005] 本发明的目的是针对现有技术的不足,提供一种基于球面电容的球面铰链运动方位测量方法,基于球冠形电容极板间的面积变化引起输出电容变化的原理,以实现球面铰链运动方位测量为目标,通过球面电容电极的布置,对球面铰链运动的三个自由度进行解耦和求解。
[0006] 本发明所采用的技术方案是:
[0007] 在球面铰链的球头底部布置第一球冠形传感电容电极,球窝底部布置第二球冠形电容电极;第一球冠形传感电容电极和第二球冠形电容电极的大小相同;在球头的赤道圆周上均匀布置2n个第三球冠形电容电极,球窝的赤道圆周上布置2n个第四球冠形电容电极,n为正整数;第三球冠形电容电极、第四球冠形电容电极的球冠对应圆心角均为θ0;其中,两个相邻第四球冠形电容电极中心间对应的圆心角为1.5θ0,另两个相邻第四球冠形电容电极中心间对应的圆心角为2.5θ0,其余每两个相邻第四球冠形电容电极中心间对应的圆心角为2θ0;在球窝紧贴第二球冠形电容电极的顶部圆周处均匀布置四个弧形传感电容电极,第二球冠形电容电极与四个弧形传感电容电极均相互绝缘;将绝对式旋转编码器的码盘固定在球面铰链的输出杆上。
[0008] 第一球冠形传感电容电极和所有的第四球冠形电容电极均加载电压VINPUT;四个弧形传感电容电极均加载电压V′INPUT;第二球冠形电容电极和所有的第三球冠形电容电极均加载电压0。
[0009] 球面铰链运动具有三个自由度,可表示为球面铰链的输出杆与竖直轴正向的夹角ψ、输出杆在水平面上的投影与水平轴正向的夹角θ和输出杆绕自身轴线的转角 ;其中绝对式旋转编码器能测出输出杆绕自身轴线的转角 。
[0010] 当输出杆倾斜时,第一球冠形传感电容电极和第二球冠形电容电极间的有效重叠面积改变,导致其电容值变化,可以解得输出杆和竖直轴正向的夹角ψ。
[0011] 对所有的第四球冠形电容电极分别编号,依次为1,2,...,2n;当输出杆倾斜时,球头赤道面和球窝赤道面始终有两个交点,其对应编号为N和N+n的第四球冠形电容电极检测到最大的电容值,则输出杆在水平面上的投影与水平轴正向的夹角θ=(N-1)×2θ0+Δθ+k×180°。其中,1≤N≤n,Δθ表示球头和球窝的赤道面交点偏离编号N的第四球冠形电容电极中心的角度,其值由编号N和编号N+n的第四球冠形电容电极与对应的第三球冠形电容电极间的电容值求出。k=0或1,可根据检测到电容值不为零的弧形传感电容电极所在的位置编号判断出k的取值,从而确定θ的值。
[0012] 本发明的有益效果是:
[0013] 1、根据球冠形电容极板间的面积变化引起输出电容变化的原理,结合绝对式旋转编码器使用,实现球面铰链运动方位的非接触式检测。
[0014] 2、采用绝对式旋转编码器直接测量球面铰链的输出杆绕自身轴线的转角大小,能获得较高的测量精度。
[0015] 3、适合球面副连接构件的角度测量,对测量装置的安装空间要求降低,结构紧凑,算法简单。

实施方案

[0022] 如图1和2所示,一种基于球面电容的球面铰链运动方位测量方法,在球面铰链的球头Q1的底部布置第一球冠形传感电容电极E1,在球窝Q2的底部设置第二球冠形电容电极E2;第一球冠形传感电容电极E1、第二球冠形电容电极E2的球冠中心与边缘间对应的圆心角均为α=60°。由于球面铰链的结构限制,所要测量的输出杆与z轴正向的夹角ψ取值范围一般不超过60°,因此第一球冠形传感电容电极和第二球冠形电容电极的有效检测面积足够大,可以满足测量要求。
[0023] 如图3所示,在球面铰链的球头赤道圆周上均匀布置三十个第三球冠形电容电极,球面铰链的球窝赤道圆周上布置三十个第四球冠形电容电极;第三球冠形电容电极、第四球冠形电容电极的球冠对应圆心角均为θ0=6°,每两个相邻第三球冠形电容电极中心间对应的圆心角均为2θ0=12°;编号15与编号16的第四球冠形电容电极中心间对应的圆心角为1.5θ0=9°,编号1与编号30的第四球冠形电容电极中心间对应的圆心角为2.5θ0=15°,编号
1至15、编号16至30的第四球冠形电容电极中,每两个第四球冠形电容电极中心间对应的圆心角为12°,保证了球头在球窝中转动到任意位置时均能输出电容信号。
[0024] 如图1、2和4所示,在球窝紧贴第二球冠形电容电极的顶部圆周处均匀布置四个弧形传感电容电极H1、H2、H3和H4,第二球冠形电容电极与四个弧形传感电容电极均相互绝缘。弧形传感电容电极在平行球窝赤道面、垂直球窝赤道面的方向上对应圆心角均为δ=6°,每两个相邻弧形传感电容电极中心间对应的圆心角均为90°;将绝对式旋转编码器Q3的码盘固定在球面铰链的输出杆上。
[0025] 如图5所示,球面铰链运动具有三个自由度,可表示为球面铰链的输出杆与z轴正向的夹角ψ、输出杆在xoy平面上的投影与x轴正向的夹角θ和输出杆绕自身轴线的转角 ;其中,绝对式旋转编码器能测出输出杆绕自身轴线旋转角度 。
[0026] 如图2和5所示,当输出杆倾斜时,第一球冠形传感电容电极E1和第二球冠形电容电极E2的有效重叠面积改变,导致其电容值变化,可以解得输出杆与z轴正向的夹角ψ。
[0027] 如图6所示,建立第一球冠形传感电容电极和第二球冠形电容电极的重叠面积数学模型,第一球冠形传感电容电极和第二球冠形电容电极的球冠中心与边缘间对应的圆心角分别为α1和α2,球头的半径为R,可得:
[0028] 曲线e1的方程:
[0029]
[0030] 曲线e2的方程:
[0031]
[0032] 曲线e1和曲线e2在球面上的存在交点P1、P2,其中P1的坐标为:
[0033]
[0034] 交点P2和P1关于yoz平面对称,因此,P2的坐标为:
[0035] P2=[x2 y2 z2]T=[-x1 y1 z1]T   (4)
[0036] 通过球心O和交点P1、P2的平面OP1P2将两个球冠的重叠面积S分成两个部分S1和S2,令平面OP1P2和平面xoz的夹角为β,则平面OP1P2和球面的交线e3的方程为:
[0037]
[0038] 式(5)中,β=tan-1[(cosα2-cosα1cosψ)/(cosα1sinψ)]。
[0039] 曲线ei(i=1,2)和曲线e3在球面上围成的面积Si的计算公式:
[0040]
[0041] 式(6)中,Di表示曲线ei(i=1,2)和曲线e3所围的面积在xoy平面上的投影。
[0042] 通过计算可得:
[0043] Si=R2{[1+sgn(cosαicosψ-cosαi+1)](1-cosαi)π+
[0044]                                                      (7)[0045] 2sgn(cosαicosψ-cosαi+1)[γicosαi-sin-1(cosηisinγi)]}[0046] 式(7)中,
[0047]
[0048] ηi=tan-1[(cosαi+1-cosαicosψ)/(cosαisinψ)],
[0049] α3=α1,
[0050]
[0051] 因此,两个球冠形电容电极的重叠面积为:
[0052]
[0053] 使α1=α2=α,因此建立第一球冠形传感电容电极和第二球冠形电容电极的重叠面积S与ψ的对应关系,记为:
[0054] S=g(ψ)   (9)
[0055] 由电容计算公式 得 代入式(9)中,其中d表示两极板间隙,ε表示介电常数,球头和球窝表面分布一层环氧树脂作为电介质;当ε和d不变时,得电容值的表达式C=f(ψ),因此输出杆和z轴正向的夹角为:
[0056] ψ=f-1(C)   (10)
[0057] 如图3、4和5所示,当输出杆倾斜角度较大时,球头赤道面和球窝赤道面始终有两个交点,其对应编号N和编号N+15(其中1≤N≤15)检测到最大的电容值时,可以得出球面铰链输出杆倾斜位置的θ大小:
[0058] θ=(N-1)×12°+Δθ+k×180°   (11)式中,Δθ表示球头和球窝的赤道面交点偏离编号N的第四球冠形电容电极中心的角度,-6°≤Δθ≤6°,其值由编号N和编号N+15的第四球冠形电容电极与各自对应的第三球冠形电容电极间的电容值求出,具体可按公式(1)至(10)的步骤求解,其中取 k的取值为0或1,并可根据检测到电容值不为零的弧形传感电容电极所在的位置编号判断出k的取值,从而确定θ的值。当弧形电极H4检测到的电容值不为零且H2电容值为零时,k=0;当弧形电极H2检测到的电容值不为零且H4电容值为零时,k=1;当弧形电极H1、H2和H4电容值都不为零,且H3电容值为零时,k=0;当弧形电极H2、H3和H4电容值都不为零,且H1电容值为零时,k=1。
[0059] 当球面铰链的球头在球窝中转动,检测到所有编号的第四球冠形电容电极上都有不为零的电容值时,说明此时球面铰链的输出杆不发生倾斜,处于竖直位置;当球面铰链的输出杆倾斜但倾斜角度较小时,部分第四球冠形电容电极检测的电容值不为零,其中编号为N电极的电容值最大,则只取编号N的电容值分析,忽略其它电容值的影响,带入式(11)中计算。
[0060] 第一球冠形传感电容电极和所有的第四球冠形电容电极均加载电压VINPUT;四个弧形传感电容电极均加载电压V′INPUT;第二球冠形电容电极和所有的第三球冠形电容电极均加载电压0。所有的电容电极均由电缆连接至电容传感器信号处理电路,计算机内置有数据采集卡和数据处理软件,对来自电容的信号进行分析处理。根据球冠形传感电容电极间的面积变化引起输出电容变化的原理,结合绝对式旋转编码器,对获得各个电容的电容量进行数据处理,就可以实现球面铰链运动方位测量。

附图说明

[0016] 图1为本发明使用的装置中各零件的结构立体图;
[0017] 图2为本发明中第一球冠形传感电容电极、第二球冠形电容电极及弧形传感电容电极的分布示意图;
[0018] 图3为本发明中第三球冠形电容电极及第四球冠形电容电极的分布示意图;
[0019] 图4为本发明中球窝底部的俯视示意图;
[0020] 图5为球面铰链的三自由度运动分析示意图;
[0021] 图6为本发明中第一球冠形传感电容电极与第二球冠形电容电极的重叠面积计算分析示意图。
版权所有:盲专网 ©2023 zlpt.xyz  蜀ICP备2023003576号