基于力位混合控制的冗余偏置机械臂末端柔顺控制方法

    公开(公告)号:CN116985145A

    公开(公告)日:2023-11-03

    申请号:CN202311248710.1

    申请日:2023-09-26

    IPC分类号: B25J9/16 B25J11/00

    摘要: 本发明公开了一种基于力位混合控制的冗余偏置机械臂末端柔顺控制方法,包括:S1):根据机械臂结构,确定机械臂#imgabs0#参数,并根据标准#imgabs1#准则建立机械臂的标准#imgabs2#坐标系,设置机械臂运动与力极限参数,建立冗余偏置机械臂的运动学模型;S2):根据步骤S1中建立的动力学模型,分别设计各方向的力控制器与位置控制器;S3):基于步骤S2)中建立的模型,设计力位混合控制控制器;S4):采用Matlab联合Adams典型轨迹仿真。本发明将位置控制器与力控制器结合设计了力位混合控制控制器,能够对机械臂末端的运行轨迹以及擦拭力进行控制,有效保证机械臂末端沿规定擦拭轨迹运动的同时实现机械臂末端在擦拭表面保持恒定清洁力。

    基于力位混合控制的冗余偏置机械臂末端柔顺控制方法

    公开(公告)号:CN116985145B

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

    申请号:CN202311248710.1

    申请日:2023-09-26

    IPC分类号: B25J9/16 B25J11/00

    摘要: 本发明公开了一种基于力位混合控制的冗余偏置机械臂末端柔顺控制方法,包括:S1):根据机械臂结构,确定机械臂 参数,并根据标准 准则建立机械臂的标准 坐标系,设置机械臂运动与力极限参数,建立冗余偏置机械臂的运动学模型;S2):根据步骤S1中建立的动力学模型,分别设计各方向的力控制器与位置控制器;S3):基于步骤S2)中建立的模型,设计力位混合控制控制器;S4):采用Matlab联合Adams典型轨迹仿真。本发明将位置控制器与力控制器结合设计了力位混合控制控制器,能够对机械臂末端的运行轨迹以及擦拭力进行控制,有效保证机械

    偏置机械臂离散点轨迹平滑规划方法、系统及存储介质

    公开(公告)号:CN116810802A

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

    申请号:CN202311083054.4

    申请日:2023-08-28

    IPC分类号: B25J9/16

    摘要: 本发明涉及机械臂空间操控技术领域,具体涉及偏置机械臂离散点轨迹平滑规划方法、系统及存储介质。包括如下步骤:步骤S1、读取并确定关节角离散点序列;步骤S2、对所述关节角离散点序列性质进行判定,步骤S3、根据预设的一级规划运动步长,进行一级速度规划;步骤S4、二次插值,得到离散点间的关节角、关节角速度、关节角加速度,实现离散点间路径的二级位置规划、速度规划、加速度规划;步骤S5、通过正运动学计算机械臂相应的末端位姿、末端速度、末端加速度;步骤S6、与预设极限值进行比较,判断其是否超限;步骤S7、输出关节角规划信息。在上层系统的输入的边界条件仅有各分段路径端点的位置的情况下,实现二次插值计算。

    偏置机械臂离散点轨迹平滑规划方法、系统及存储介质

    公开(公告)号:CN116810802B

    公开(公告)日:2024-01-26

    申请号:CN202311083054.4

    申请日:2023-08-28

    IPC分类号: B25J9/16

    摘要: 本发明涉及机械臂空间操控技术领域,具体涉及偏置机械臂离散点轨迹平滑规划方法、系统及存储介质。包括如下步骤:步骤S1、读取并确定关节角离散点序列;步骤S2、对所述关节角离散点序列性质进行判定,步骤S3、根据预设的一级规划运动步长,进行一级速度规划;步骤S4、二次插值,得到离散点间的关节角、关节角速度、关节角加速度,实现离散点间路径的二级位置规划、速度规划、加速度规划;步骤S5、通过正运动学计算机械臂相应的末端位姿、末端速度、末端加速度;步骤S6、与预设极限值进行比较,判断其是否超限;步骤S7、输出关节角规划信息。在上层系统的输入的边界条件仅有各分段路径端点的位置的情况下,实现二次插值计算。