球形机器人机构及其运动学建模1

球形机器人机构及其运动学建模0.前言球形机器人是一个古老而又有趣的课题。人类对球形机器人的研究，最早可以追邀到一个世纪以前。但在以后的相当长的时间内，由于条件的限制，没有实质的进展。近年来，随着科学的发展和技术的进步，球形机器人的研究热潮悄然兴起。国外对球形机器人的研究起步比较早，而且也提出了多种机器人系统的方案，有的甚至已经产品化。相比之下，国内对它的研究就比较少，方案也较简单。目前，国内外的球形机器人大都基于重力驱动。也就是说通过某种机构改变整个系统的重心，使它偏离球体的中心，并利用重力来获得驱动力矩。在国内外已有的驱动方案中，驱动机构大都很复杂，而且需要整个球壳的内部空间作为其运行的空间。这个缺点限制了球形机器人在很多方面的应用。本文在参考了多个驱动方案的基础上，提出了一种新的驱动方案。它结构简洁、占用空间少，正好克服了球形机器人的上述缺点。机构设计本文的球形机器人结构如图1所示。它由球壳R四个驱动电机Da、Db、DC、DD和四个偏心重块MA、Mb、Mc、MD组成。四个电机分别安装在球壳内壁的四个点A、B、C、D上，这四个点正好组成球壳的一个内接正四面体。并且每个电机的转轴都指向球心。。偏心重块和电机的转轴联接在一起。这样，当电机带动重块旋转时，球形机器人系统的分布就会相应的改变，从而达到改变重心的目的。记球壳的质为M；电机的质量忽略不计；偏心重量块的质量分别为mA、mB、mc、mD，它们的铰接点到球心距离为"偏心距为r。Zp整个机器人系统的自由度计算如下:（1）歹YV八（1）=6n-乙p-乙q-乙Ri=1j=1式中n——活动构件总数；Pi，m——第i个运动副的约束条件数，运动副总数；qj，X第j个原动机的驱动约束条件个数，原动机总数;7Rk——其他约束条件数。系统活动构件总数n为5,运动副总约束为：TOC\o"1-5"\h\z芸p=1+5+5+5+5=21（2）i=1原动机的约束条件总数为：Zq=1+1+1+1+1=4（3）j=i其他约束条件数为2,即x向和j向的纯滚动摩擦约束。所以机构的自由度为F=6x5-21-4-2=3（4）因为F>0且Zq>0，所以由机械原理可知，如图1的球形机器人没有确定的相对运动，此时系统在地面摩擦力和重力的作用下，按牛顿定律运动。又因为F=3,所以只要给定球体的横滚、俯仰、偏斜角奴0,p，就可以确定机器人的位置和姿态。坐标系建立为了便于分析及计算，需要为球形机器人系统建立合适的坐标系。按一般机器人原理，本文建立了如下坐标系：C——世界做标系；固定在地面上；C——球体坐标系；固定在球体上，并随球体运动。原点在球心。该坐标系用来指示p球体的姿态；Ca、Cb、Cc、Cd——偏心质量坐标系；原点分别在各偏心质量的转动中心，并且他们的Z轴都指向球心。Ca、Cb、Cc、Cd用以标志偏心质量的转角。（5）设cp的位置为［xjrr，它的横滚、俯仰、偏斜角分别为奴o,p，那么，Cp相对于世界坐标系（5）T=Trans(x,j,R)RPY(。，0,p)Cb、CaCb、Ca、Cc、Cb、Cc、Cd和球体坐标系Cp间的是相对固定的，它们之间没有相对运动，所以Ca、Cd和Cp间的变换矩阵Aa、Ab、Ac、Ad都为常矩阵。为便于计算，本文取II=II「IIIA,=|bII22III「IIIA,=|bII22IIIAJA.一1III0—□/333—100002*211—_□/3330001旦5—£——□/66331_—4—云—□/2633是女11—_□/333300011「*3I—3II0Il6I-—3L0233旦30寸21-3—'I\：61—□/|3I11——□|3I1I偏心质量坐标系Ca、Cb、Cc、Cd和世界坐标系Cp间的变换矩阵：T=TAiG(a,b,c,d)(6)运动学逆解球形机器人的运动主要通过改变系统质心实现的。因此，机器人运动学的问题可以分作两个小问题：质心位置对机器人运行的影响问题和给定运动状态下质心的控制问题。本文是对机器人系统运动的初步研究，只探讨了在静止状态下的运动学正解和逆解问题。球形机器人的运动学逆解问题可以描述为：已知球体的姿态角奴0,p，并给定机器人系统质心在世界坐标系中相对于球心的坐标p=(A匚M,Az)t，求各偏心质量的转角a,a,a,a。偏心质量m在各自坐标系C,ig{A,B,C,D}中的坐标可表示为：「cosa]pCi=sina"尸(7)iIiI

四个质量块的在全局坐标系中的合质心坐标为:(8)D(8)TOC\o"1-5"\h\zp=27?PF（（|）0（p4PCi

ciii=A由矩阵原理可知，方程（8）是多解方程，它有无穷多解。要想得到唯一解，必须给方程（8）添加约束。取下面的约束条件：f(a,a,a,a)=Ea-a0minzg{a,B,C,d}(9)ABCDiii=A式中a。为当前重块的偏转角。约束（9）的实际物理意义是：求aig{A,B,C,D}使ii各重块相对于当前位置的偏转角总和为最小。从能耗方面来说，符合约束（9）的解，应该是一个比较好的解。因为为常数，所以方程（8）可以最终化简为如下形式：[Ax=k+£\Ay[Ax=k+£\Ay=k+£△z=k+NIzaDeosaxiaDeosayiaDeosazi+£bDsina_xi+£bDsina+2bDsinazi(10)球形机器人的运动学正解问题可以描述为：已知球体的姿态角奴。叩，并给定各偏心质量的转角a,a,a,a,求机器人系统质心相对于球心的坐标（Ax,Ay,A^）r°将ABCDa,a,a,a代入方程（8）得：ABCD£cos°cos0211'+cos°sin0sin中一sin°cos0cosa□r22r1cos°cos0+|2\(—cos°sin0sinr1cos°cos0+3\r3cos°cos0I6(cos°sin0sin中—2中+sin°cos0)cosabsin°cos0)□rsinaa□r(cos°sin0cos中3+sin°sin0)sin□rb/126_zcos°sin0sin中一sin°cos0+(cos°sin0cos中23sin°sin0)cosa□rc5cos°cos06(cos°6sin0sin中买(—sin°cos0)+(cos°sin0cos+sin°sin0)sin□rc\r+rcos°cos0(cos°3sin0cos中+sin°sin0)2cos°cos03(cos°3sin0sin中r(cos°sin0cos中+sin°sin0)—3\电1sin°cos0+sin°sin0sin中2r1sin°cos0+2\(sin°sin0sin中r1sin°cos0+〔3(公|sin°cos0165sin°cos06\r+rsin°cos02sin°cos03—sin°cos0)+w(cos3°sin0cos+sin°sin0)sin□rd1cos°cos031)+cos°cos中2(sin°sin0sin中+cos°cos中)223cos°cos0□lcosasina□ra□ra+cos°cos中)cosa□rb1(sin°sin0cos中3—cos°sin中)1sin°sin0sin中+21cos°cos中+2sin(sin°sin0cos中3cos°sin中)cosa□rc立((sin6(sin3日((sin3sin0sin0sin0sin中cos中sin+cos0cos)+十(sin°sin0cos—cos°sin中)sin□rc—cos°+cos°sincoscosa□r

d)+壬((sin3°sin0cos—cos°sin中)sin□rdr2,..。一(sin°sin0cos中—cos3\sin中)-sin°cos0+32*3sin3°cos0□l，<31_'Az=-sin0+—cos0sincpcosaDr+22a7f2(1-—sin0+22cos0sincpsinaUrcos0sincosaDr+

h