机械化沉井挖掘机器人运动学正逆解解析方法

    公开(公告)号:CN117301054A

    公开(公告)日:2023-12-29

    申请号:CN202311241447.3

    申请日:2023-09-25

    IPC分类号: B25J9/16 G06F17/11 G06F17/16

    摘要: 本发明公开了一种机械化沉井挖掘机器人运动学正逆解解析方法,沉井机器人主要由转台、配重、动臂、二节臂、关节臂和疏浚泵等六个部分组成。回转马达、变幅油缸、伸缩油缸、关节油缸、摆动油缸为机器人各运动关节部件。回转马达驱动转台实现机器人水平方向上的旋转,并配置编码器可采集其旋转角度。变幅油缸的伸缩使动臂相对于转台在竖直平面转动,动臂和二节臂间的伸缩油缸可实现二节臂相对于动臂的伸缩,关节油缸的伸缩使得关节臂旋转,摆动油缸的伸缩可使疏浚泵相较于关节臂的左右摆动,上述的运动最终表现为绞吸头的空间运动。变幅油缸、伸缩油缸、关节油缸、摆动油缸均配置高精度行程传感器。本发明解析方法,计算精度高、运算速度快效率高,同时,逆解物理意义明确直观,多解问题解决方便,有利于算法的工程应用。

    盾构推进系统压力闭环控制方法及系统

    公开(公告)号:CN115012961A

    公开(公告)日:2022-09-06

    申请号:CN202210287400.X

    申请日:2022-03-22

    IPC分类号: E21D9/06 E21D9/093

    摘要: 本发明涉及一种盾构推进系统压力闭环控制方法及系统,该方法包括:获取推进系统的总顶推力、水平合力矩以及垂直合力矩;建立全局坐标系,并计算总顶推力力矩点的力矩夹角;利用力矩夹角除以两千斤顶的圆心角得到对应的千斤顶;在全局坐标系中建立局部坐标系,让局部坐标系的y轴负半轴穿过所得到的对应的千斤顶的中心,将x轴对应y轴正方向的一侧定义为减压区,将x轴对应y轴负方向的一侧定义为增压区;利用垂直合力矩计算得出对应增压区和减压区的顶力增量;利用顶力增量与总顶推力计算得出对应的千斤顶的目标顶力。本发明根据水平合力矩和垂直合力矩实时调整推进系统的增压区及减压区,从而实现推进系统压力的精准控制。