能实现消防栓对接的消防机器人系统及其控制方法

    公开(公告)号:CN118557922B

    公开(公告)日:2024-09-27

    申请号:CN202411051855.7

    申请日:2024-08-01

    Abstract: 本发明公开一种能实现消防栓对接的消防机器人系统及其控制方法,方法包括:步骤1,用预先建立的自适应导纳控制器控制消防机器人,由机器人利用深度相机对消防栓位姿初步定位后,移至定位处进行对接;步骤2,由机器人夹持消防水带与消防栓对接,并对接产生的当前接触力预测机械臂末端位置偏差,引导消防机器人调末端位置消除位置偏差;步骤3,经预建立的复合高斯模型用机器人反馈的关节角度计算对接插孔深度,用拟合出的对接接触力‑深度预测曲线,预测当前插孔深度的对接接触力,调整对自适应导纳控制器的导纳参数,在调整导纳参数的自适应导纳控制器控制下,由消除末端位置偏差机器人的机械臂将消防水带平滑插入消防栓,完成消防栓对接任务。

    能实现消防栓对接的消防机器人系统及其控制方法

    公开(公告)号:CN118557922A

    公开(公告)日:2024-08-30

    申请号:CN202411051855.7

    申请日:2024-08-01

    Abstract: 本发明公开一种能实现消防栓对接的消防机器人系统及其控制方法,方法包括:步骤1,用预先建立的自适应导纳控制器控制消防机器人,由机器人利用深度相机对消防栓位姿初步定位后,移至定位处进行对接;步骤2,由机器人夹持消防水带与消防栓对接,并对接产生的当前接触力预测机械臂末端位置偏差,引导消防机器人调末端位置消除位置偏差;步骤3,经预建立的复合高斯模型用机器人反馈的关节角度计算对接插孔深度,用拟合出的对接接触力‑深度预测曲线,预测当前插孔深度的对接接触力,调整对自适应导纳控制器的导纳参数,在调整导纳参数的自适应导纳控制器控制下,由消除末端位置偏差机器人的机械臂将消防水带平滑插入消防栓,完成消防栓对接任务。

Patent Agency Ranking