自平衡独轮车动力学模型的建立.docxVIP

2 自平衡独轮车动力学模型的建立 2.1 自平衡的原理 动态平衡原理即为自平衡独轮车的工作原理。通过运动补偿算法，运用加速度传感器和陀螺仪对车体姿态测试，同时借助精密的伺服控制系统高敏地对电机进行驱动，并作适度的调节，从而使整个车体的平衡性以及稳定性得到确保。由图 2.1能够得出，自平衡独轮车的车体摆动和它的转动是存在一定分离性的，驾驶人员的两腿将车身的两端夹紧，进而和车体产生了一个整体。一旦其身体倾向后方，那么驱动车轮就会朝后转，从而防止车体倒向后方；反之，若是朝前，那么车轮就会朝钱转；若其身体处于竖直状态，那么则独轮车也就表现为动态平衡。独轮车控制系统的重中之重就是平衡控制。就自平衡独轮车加以建模并做深度分析，便能够对系统的特性产生更多的了解，这对于相应控制算法的设计规划甚为有益。 图2.1 2.2动力学建模 2.2.1 物理模型化简 自平衡独轮车不是平面机构，需要采用空间坐标的方式对其进行分析，坐标定义可详见图2.2，能够看出其自由度共有6个，其中平移、旋转各为3个。俯仰角Ψ、横滚角γ、偏航角Φ均为其旋转姿态角。因为独轮车的左右方向以驾驶者自身的调节为主，只能够控制前方和后方，故而把模型简单化至 x o z平面，仅对这两个方向上的平衡控制进行探讨。 图 2.2 运动学是力学的一个分支，主要是站在几何的视角上来对物体位置伴随时间的波动规律进行阐述及探究的，刚体的运动学以对其自身的运动特性的研究为主，譬如转动经过、位移、角速度及其加速度等。由于有部分难以测得的因素存在于独轮车的机械零件以及运动经过当中，因而必须对其做简化建模，因此作如下假设： 1驾驶者和独轮车运动相同，可将二者看成一个整体，假定是刚体； 2行走轮为质心在圆心的空心圆环； 3在独轮车行驶期间，车轮和地面从始至终都处于彼此接触的状态，且一直是纯滚动； 4忽略其他摩擦和外界干扰。 基于以上条件，我们进行独轮车物理模型化简 如图2.3，Φ为车轮转过的角度，θ为车体的倾角。 图2.3 为了方便建模，我们做出了参数定义 如表2.1 表2.1 符号（单位） 定义 M (kg) 车与人总质量 Ip(kg?m2) 车身对电机转轴的转动惯量 m (kg) 电机总质量 Φ(rad) 独轮车运动过程中车轮转过的角度 I (kg?m2) 车轮对电机转轴的转动惯量 L (m) 质心到电机转轴的距离 θ(rad) 车身俯仰角 r (m) 车轮半径 f(N) 地面对车轮水平方向的摩擦力 (xp,yp)(m) 车身等效质心位置 T(N?m) 电机的输出转矩 F(N) 车轮与车体间水平方向的作用力 (x,y) (m) 车轮质心位置 N(N) 车轮与车体间垂直方向的作用力 P(N) 地面对车轮竖直方向的支持力 测出电机和轮胎质量 m、 车身和骑行者质量 M、车身等效质心至电机转轴的间距 L、车轮半径r分别为10kg、80kg、0.8m、0.2m。 按照运算转动惯量的公式，即可把车轮、车身二者分别对电机转轴的转动惯量、算出，即 （ 2.1 ） 　　　　 （ 2.2 ） 2.2.2 动力学建模 本文采用牛顿力学分析方法，主要对自平衡独轮车车轮的受力情况进行研究，将动力学方程全面得出。该研究法见图 2.4能够体现出来 。 图 2.4 经过分析，得到车轮的受力表示图，由图知道车轮受力情况可分为两种，一种是水平方向，另一种是竖直方向，同时车轮本身存在转矩，分析后可建立下列方程： 水平方向： 　　　　　　　　　 ( 2.3 ) 竖直方向： 　　　　　　 ( 2.4 ) 车轮转矩方程 ： 　　　　　　　 （2.5） 车轮位移加速度和转动角加速度存在如下关系 ：