机器人运动模型
由其他组采集到的轮速数据需要根据公式将速度转化为位移量,具体机器人运动模型有两大类。如下:
模型1
模型1 同类表达1-1
模型1 同类表达1-2
模型2
模型2 同类表达2-1
用轮速计实现双轮差动机器人的位姿估计
模型2 同类表达2-2 (图中坐标xy与公式相反)
模型2 同类表达2-3
mode 1
http://faculty.salina.k-state.edu/tim/robotics_sg/Control/kinematics/unicycle.html
12.1.3. The Unicycle Model
Dealing with the displacement and velocities of the two wheels of a differential drive robot is messy. A preferred model is that of a unicycle, where we can think of the robot as having one wheel that can move with a desired velocity () at a specified heading (). Having the equations to translate between the unicycle model and our wheel velocities is what allows us to simplify the robot with the unicycle model. We have seen how to take measured wheel displacements to calculate the new robot pose. Now we do the reverse and calculate the desired wheel velocities from the unicycle model.
The Simplified Unicycle Robot Model
Note
We represent the measured forward velocity and robot orientation with variables and . The desired speed and direction are represented with the unicycle model using variables and .
In the global coordinate frame, we can represent the velocity of the unicycle robot as:
(1)
12.1.3.1. The Jacobian
The kinematics of mechanical systems are often described in terms of Jacobian matrices. A Jacobian defines how movement of parts of a system affect the movement of the whole or a larger part of the system. Let be the velocity vector of the system, be the pose of the system, and