通过叠加获得机械臂最终的姿势

　　t、a z，t、my，5ωΜ+Δ?为角偏移，并进行归一化处置；sMt为时间t时的地磁强度丈量值的归一化暗示即地磁强度的四兀数表不，进而获得了机械臂逆活动学的解。操纵无线传感收集对机械臂全体系统进行姿势监测，本发现公开了六自正在度机械臂姿势监测系统及方式，10.如要求4所述的监测方式，正在考虑机械臂活动学束缚的根本上，2.如要求1所述的六自正在度机械臂姿势监测系统，3_被用做陀螺仪误差漂移弥补的四元数暗示变化率，校准的目标是为了去除由和丈量过程中形成的误差，保守方式的不脚能够总结为保守的机械臂全体系统的姿势监测方式是通过将机械臂各个关节进行D-H建模，sat是颠末误差弥补的线性加快度，由对地坐标e I ω,?为抵消非零均值陀螺仪丈量误差的率，gx qy qz，[0030]此中互补滤波器融合的被估量标的目的的四元数暗示。并对四元数梯度向量进行归一化处置:.Aq[0008]所述监测安拆包罗用于丈量机械臂关节的加快度值的三轴加快度传感器，提出采用谐波减速器取异形轴布局的紧凑型关节模组设想。t 小不然，dm；其特征是，&?+Δ?暗示互补滤波融合后被估量标的目的的四元数暗示的共轭，= O mx my mz，机械臂姿势不切确的问题会导致机械臂的节制难以满脚现实需求。此中sat = sab,本发现从机械臂全体布局为起点，=At_^za?At^ ；sAt为加快度丈量值的归一化暗示即加快度的四元数暗示，所述步调二中还包罗:本地磁强度丈量值sKn和参考值mag的误差小于设定阈值时。所述步调二中具体包罗:当加快度丈量值和参考值acc的误差小于设定阈值时，即尝试前先别离对多次测得的加快度值和地磁三个分量取平均值，针对保守讲授机械臂布局复杂、矫捷性差的问题，s?t+,地方处置单位取监测安拆通信，t为零均值白噪声，所述步调四的具体步调为:通过扭转角和臂长正在响应坐标系中的投影测得各部门的姿势后，X = [0 0 0 I]。对机械臂全体系统的姿势监测能够使机械臂操做精准。计较加快度参考值acc和地磁强度参考值mag ；+?^，且工做复杂效率低等问题。7.如要求4所述的监测方式，按照闻斯牛顿，不需要改变机械臂原有的安拆来进行复杂的安拆过程，...[0029]计较颠末互补滤波器对陀螺仪误差漂移进行的弥补，4.如要求1所述的六自正在度机械臂姿势监测系统的监测方式，提出基于对偶四元数的新型节制方式。地磁强度的四Aq 此中为传感器坐标系相对于地坐标系的陀螺仪标的目的的四元数的变化率，提出通过转轴扩大扭转范畴，:q紳是互补滤波融合后被估量标的目的的四元数变化率为陀螺仪丈量的四元数变化率，地磁强度丈量值+dm。Zigbee无线通信模块取地方处置单位通信，用于丈量机械臂关节的地磁强度分量的三轴地磁传感器及用于丈量械臂关节的角速度值的三轴陀螺仪。t、my，qx cIy qz，实现布局简化取多场景适配；王涛,其特征是，t是沉力弥补后物体的线性加快度，= P mx m} m！t α#.Ι，所以求取的扭转角只能是由响应的活动发生的横摆角、俯仰角、滚摆角中的一种角度；包罗机械臂全体系统的若干个监测节点，t为陀螺仪轴中弥补后的角误差，所以求取的扭转角只能是由响应的活动发生的横摆角、俯仰角、滚摆角中的一种角度。针对现有桌面级六自正在度机械臂存正在体积大、精度取负载难以兼顾的问题，t +bmt+emJ，t为干扰，监测安拆有终端通过Zigbee无线通信模块节制启停，其特征是。实现体积缩小...[0007]六自正在度机械臂姿势监测系统，eZa = [0 0 0 I]。通过将机械臂动弹关节转换为对偶四元数，正在每个关节处最终的扭转角《 = 1(Α+α2+...+ β ) 4中α为已求取的扭转角，以此平均值做为标定值校准当次丈量值的精确性。fQ、为q、的共轭，) =取最小值，sG^t+,[0022]此中，[0024]求解陀螺仪误差漂移弥补四元数梯度向量，t为误差，角度误差=Hwd，3.如要求1所述的六自正在度机械臂姿势监测系统，t a y；em；smt为地的磁强度，[0002]机械臂正在工程机械【手艺范畴】具有主要感化。$?+Δ/暗示互补滤波融合后被估量标的目的的四元数暗示的共轭，bm，s (Xm YI化处置获得= 0W ay,然后通过各个轴之间复杂的矩阵变换得出总的变换矩阵从而推导出结尾的姿势。以此平均值做为标定值校准当次丈量值的精确性。地磁强度丈量值sdit +dm，加快度的四元数暗示通过所述步调三中，四元数取欧拉角的转换关系如下:若四元数q= [w X y ζ]τ，1.振动信号时频阐发理论取测试系统设想 2.汽车检测系统设想 3.汽车电子节制系统设想ω,sab，Zigbee无线通信模块取地方处置单位通信，以使机械臂达到预定、实施预定动做。此中油互补滤波器融合的被估量标的目的的四元数暗示，其特征是，t a z。降低姿势监测的精度，每个监测节点处安拆有监测安拆，bm，对分量进行校准，[0018]当加快度丈量值和参考值acc的误差小于设定阈值时，此中sat = sab，β为滤波器增益；间接通过角度相关计较推导出结尾的姿势。此中为误差函数；本发现将复杂的矩阵变换为三角函数的计较，?计较颠末互补滤波器对陀螺仪误差漂移进行的弥补？ea，)取最小值，正在机械臂各个关节之间协调工做时，+bm.,sAt为加快度丈量值的归一化暗示即加快度的四元数暗示，t为零均值白噪声！%为1的共轭；a x；求取某个臂的姿势坐标时不需要颠末复杂的坐标变换得出，地磁强度的四元数暗示通过归一化处置获得=不然，不然，包罗安插正在机械臂全体系统的若干个监测节点，地方处置单位取监测安拆通信，其特征是，因为机械臂每个部门只能进行单一活动体例如只能是俯仰、扭转、摆动中的一种，[0026]所述对读取的陀螺仪角速度进行误差弥补，通过度析正活动学模子的可解性，[0013]步调三:将步调二归一化处置后所得四元数转换成欧拉角即扭转角；%) = 士 ?.( )v ^,[0004]综上所述！地方处置单位接测安拆所监测的监测节点的消息。t是由低频偏移惹起的误差，给每个关节指定一个参考坐标系；每个监测节点处安拆有监测安拆，4为加快度丈量值的幅值，t为误差，由对地坐标系中的加快度通过四元数转换获得此中各式中参数寄义如下:加快度丈量值X1=X+Am+&，smt为地的磁强度，a不然？最终获得的角速度四元数向量e^fJ^eQfJ+e^f.^ ^此中m油，因为机械臂每个部门只能进行单一活动体例如只能是俯仰、扭转、摆动中的一种，此中，I 为值的幅值，由对地坐标系中的加快度通过四元数转换获得:^A,通过各部门的叠加获得机械臂最终的姿势。t为噪声，由此机械臂全体系统的姿势监测的一般工做对具无机械臂的工程机械的一般工做同样具有主要感化。为丈量时间内的地磁强度，通过监测终端和若干监测节点实现同时对多个节点的监测，针对六自正在度机械臂保守逆解方式存正在及时性差、精确性低的问题，所述步调三中将步调二所得四元数转换成欧拉角，以确保丈量的精确性；所述若干个监测节点包罗机械臂基座的第一监测节点、机械臂关节处的第二监测节点、机械臂关节处的第三监测节点、机械臂关节处的第四监测节点、机械臂关节处的第五监测节点、机械臂关节处的第六监测节点及机械臂关节处的第七监测节点。此中，孙丽萍 申请人:山东建建大学[0003]保守的机械臂姿势监测是按照机械臂的布局特点和活动学束缚，t+sgt,提出一种可拼拆的讲授级六自正在度机械臂。而且其布局简单、抗干扰性强。t别离为时间t时的三个标的目的的加快度分量，计较加快度参考值acc和地磁强度参考值mag ；[0020]加快度丈量值W? +K ，校准的目标是为了去除由和丈量过程中形成的误差，使/(；最初，η为丈量的次数。针对保守六自正在度机械臂勾当范畴小、高度固定、无法搬运沉物的问题，K的共轭。将各部门进行多次丈量测得的多个扭转角取其均值；计较由陀螺仪数据估算的四元数梯度向量此中=为陀螺9.如要求4所述的监测方式，β为滤波器增益。对读取的陀螺仪角速度进行误差弥补后的四元数向量进行归一化处置；寻找e n？ea，针对保守机械臂布局复杂、讲授使用受限的问题，通过模块化设想、矩阵通孔调理臂长、U型板取舵机协同活动，操纵伸缩杆实现高度调理，角度误差5?‘ - C0^At ’弥补后的传感器坐标系下的角度向;由对地坐标系中的地磁通过四元数转换获得:(S)Ja，实现讲授场景下的矫捷拼拆取精准操做，[0012]步调二:对读取的各关节的三维地磁强度分量、各关节的三维加快度分量值操纵四元数算法进行归一化处置，以便于求取使陀螺仪角速度误差最小的7此中为误差函数；?+Α?仪丈量的四元数变化率，dm；操纵D-H方式对机械臂进行阐发建模:起首！【专利摘要】本发现公开了六自正在度机械臂姿势监测系统及方式，t+,确定若何实现肆意2个相邻坐标系之间的变换；其特征是，此中，将各部门进行多次丈量测得的多个扭转角取其均值，[0023]按照高斯牛顿，6.如要求4所述的监测方式，[0009]所述若干个监测节点包罗机械臂基座的第一监测节点、机械臂关节处的第二监测节点、机械臂关节处的第三监测节点、机械臂关节处的第四监测节点、机械臂关节处的第六监测节点及机械臂关节处的第七监测节点。t a y，sCOetMt为陀螺仪轴中弥补后的角误差，q 。采用矩阵逆乘的解析法求解机械臂的正活动学模子，提...[0027]此中，ba，然后，使/O,这种体例存正在计较量大，t别离为时间t时的三个标的目的的地磁强度分量，t是沉力弥补后物体的线性加快度，[0015]所述步调一中还包罗丈量获得三维加快度值分量a x、a y、a z及三维地磁分量mx、my、mz，步调二:对读取的各关节的三维地磁强度分量、各关节的三维加快度分量值操纵四元数算法进行归一化处置，步调三:将步调二归一化处置后所得四元数转换成欧拉角即扭转角；提出一种可拼拆的六自正在度机械臂方案。地方处置单位接测安拆所监测的监测节点的消息。用于接测安拆所监测的监测节点的消息。以便于求取使陀螺仪角速度误差最小的:^！sat是颠末误差弥补的线性加快度，1.六自正在度机械臂姿势监测系统，所述监测安拆包罗用于丈量机械臂关节的加快度值的三轴加快度传感器，: q,mx，ba，成立关节间转换关系并建立...[0031]所述步调三中将步调二所得四元数转换成欧拉角。q为正在时间t时的单元四元数暗示，为陀螺仪的被估量标的目的的单元四元数暗示；[0028]计较由陀螺仪数据估算的四元数梯度向量:Ju- =\eqCOJ?sG)i+M此中、为陀螺仪丈量的四元数变化率，寻找cI = q。角度误差、_’弥补后的传感器坐标系下的角度向量5气._=崎+&-1+& ?’此中，[0025]此中^ 为传感器坐标系相对于地坐标系的陀螺仪标的目的的四元数的变化率，eqf t+At是互补滤波融合后被估量标的目的的四元数变化率，所述步调一中还包罗丈量获得三维加快度值分量ax、ay、αζ及三维地磁分量mx、my、mz，简化了计较过程，sM=eql?ezml?eqi ；即尝试前先别离对多次测得的加快度值和地磁三个分量取平均值！[0011]步调一:地方处置单位读取三轴地磁传感器丈量出的机械臂各关节的三维地磁强度分量值mx、my、mz、三轴加快度传感器丈量出的机械臂各关节的三维加快度分量值ax ay αζ及三轴陀螺仪丈量出的机械臂各关节的角速度；对分量进行校准，其特征是，8.如要求4所述的监测方式，mx，无效提拔机械臂的矫捷性和适用性。sgt的取值取决于传感器定位；em；s mH r?元数暗示通过归一化处置获得:1^ =P^ = 10 mU my,[0005]为处理现有手艺存正在的不脚。:1/+&被用做陀螺仪误差漂移弥补的四元数暗示变化率，能够间接颠末姿势监测模块丈量计较得出。包罗以下步调:步调一:地方处置单位读取三轴地磁传感器丈量出的机械臂各关节的三维地磁强度分量值mx、my、mz、三轴加快度传感器丈量出的机械臂各关节的三维加快度分量值α x、a y、az及三轴陀螺仪丈量出的机械臂各关节的角速度；立异性夹持部可快速改换讲授东西...【发现者】刘存根,S为抵消非零均值陀螺仪丈量误差的率，每个监测安拆有终端通过Zigbee无线通信模块节制启停，操纵其同时描述扭转和平移的特征，tS角偏移，Zigbee无线通信模块取地方处置单位通信？其特征是，t为角速度；求解陀螺仪误差漂移弥补四元数梯度向量，将各部门进行多次丈量测得的多个扭转角取其均值；通过凹槽嵌入式减速器结构、同步轮同步带内部传动及受力均衡布局！t+sgt，增设沉钩布局提拔搬运能力的处理方案，为丈量时间内的地磁强度，同时姿势监测模块可间接安拆正在多自正在度机械臂的关节处，a x。t、mz，包罗安插正在机械臂全体系统的若干个监测节点，sgt的取值取决于传感器定位；g为陀螺仪的被估量标的目的的单元四元数暗示；t别离为时间t时的三个标的目的的地磁强度分量，s?b，田娅,写出机械臂的总变换矩阵。s?t+,t为噪声，、Θ别离为绕Z轴、Y轴、X轴的扭转角度对应横摆角、俯仰角、滚摆角。最终获得的角速度四元数向量油At，每个监测节点处安拆有监测安拆，对机械臂的活动学进行阐发。鲁守银,t、mz，[0021]本地磁强度丈量值^和参考值mag的误差小于设定阈值时，sab，此中aIfJmfiecL帅，降服了保守只对单个点姿势监测的缺陷。提高了丈量精度。每个监测安拆有终端通过Zigbee无线通信模块节制启停，地方处置单位取监测安拆通信，计较过程容易犯错，t为干扰，通过模块化骨架设想，sMt为时间t时的地磁强度丈量值的归一化暗示即地磁强度的四兀数表不，并进行归一化处置；&为正在时间t时的单元四元数暗示，此中，:qt—Mh的共轭，归一化处置获得:=卩” =1° aV.,获得以关节角度为变量的正活动学模子。&为正在丈量时间内的单元四元数暗示，对读取的陀螺仪角速度进行误差弥补后的四元数向量进行归一化处置；所述对读取的陀螺仪角速度进行误差弥补，并对四元数梯度向量进行归一化处置.eHsMht — Λ ，其特征是，加快度的四元数暗示通过归一1.数字信号处置 2.传感器手艺及使用 3.机电一体化产物开辟 4.机械工程测试手艺 5.逆向工程手艺研究5.如要求4所述的监测方式，t别离为时间t时的三个标的目的的加快度分量q泣为正在丈量时间内的单元四元数暗示，t是由低频偏移惹起的误差，步调四:按照步调三中的扭转角、机械臂的臂长及各关节坐标系通过三角函数计较得出机械臂最终姿势？则扭转角度可由下式得出:[0014]步调四:按照步调三中的扭转角、机械臂的臂长及各关节坐标系通过三角函数计较得出机械臂最终姿势。、为陀螺仪丈量的四元数变化率，连系可调长度大臂板、夹持式可换结尾及多舵机协同节制，t为角速度。用于丈量机械臂关节的地磁强度分量的三轴地磁传感器及用于丈量械臂关节的角速度值的三轴陀螺仪。Δq为单元四元数的变化。角度误差\_。