弹簧阻尼双足机器人髋关节连接一弹簧阻尼质量模块(弹簧阻尼质量模块只能在水平方向运动),在运动过程中单支撑阶段拉格朗日动力学方程
时间: 2023-06-10 16:06:49 浏览: 51
对于一个弹簧阻尼双足机器人的髋关节连接一弹簧阻尼质量模块,可以考虑采用拉格朗日动力学方法来描述其运动状态。在单支撑阶段,机器人的运动可以被简化为在一个平面上的运动,因此只需要考虑机器人在水平方向上的运动状态。
设机器人的质心位置为 $x_c$,质量为 $m_c$,弹簧阻尼质量模块的位置为 $x_{m}$,质量为 $m_{m}$,弹簧的劲度系数为 $k$,阻尼系数为 $c$,地面支持力为 $F$。
由拉格朗日动力学理论可知,机器人在单支撑阶段的运动可以用以下拉格朗日函数来描述:
$$L=T-V=\frac{1}{2}m_c\dot{x_c}^2+\frac{1}{2}m_m\dot{x_m}^2-\frac{1}{2}k(x_c-x_{m})^2-\frac{1}{2}c(\dot{x_c}-\dot{x_m})^2+m_cg(x_c)+m_mg(x_{m})$$
其中,$T$ 表示机器人的动能,$V$ 表示机器人的势能,$g(x_c)$ 和 $g(x_{m})$ 分别表示机器人质心和弹簧阻尼质量模块的重力势能。
接下来,根据拉格朗日方程可以得到机器人在水平方向上的运动方程:
$$\frac{d}{dt}\frac{\partial L}{\partial \dot{x_c}}-\frac{\partial L}{\partial x_c}=\frac{F-k(x_c-x_m)-c(\dot{x_c}-\dot{x_m})}{m_c}$$
$$\frac{d}{dt}\frac{\partial L}{\partial \dot{x_m}}-\frac{\partial L}{\partial x_m}=\frac{k(x_c-x_m)+c(\dot{x_c}-\dot{x_m})}{m_m}$$
这两个方程表示了机器人质心和弹簧阻尼质量模块的运动状态,可以通过数值计算的方法求解出机器人在单支撑阶段的运动轨迹。