公开(公告)号：CN116330271A

公开(公告)日：2023-06-27

申请号：CN202211477596.5

申请日：2022-11-23

Applicant: 中国长峰机电技术研究设计院

Inventor： 李嘉科 ,  魏琦 ,  马喆 ,  赵荣利 ,  孙科武 ,  黄旭辉 ,  姚保寅 ,  毛磊

IPC: B25J9/16 ,  B25J9/06 ,  B25J9/08

Abstract: 本发明的目的在于提供一种蛇形机器人的控制方法，通过控制单元控制驱动结构实现功能模块的拼接。并通过多个拼接后的功能模块之间的配合实现蛇形机器人的前进、攀爬、蔽障、缠绕等动作。控制单元获取外部环境信息，根据外部环境信息确定活动计划。此外控制单元还接收其他功能模块的行动信息，根据其他功能模块的行动信息的优先级和本功能模块的活动计划的优先级确定执行计划，执行计划是本功能模块实际执行的计划。将本功能模块的行动信息发送给其他功能模块。本模块的行动信息包括活动计划、执行计划和执行计划对应的动作。按照控制指令的要求，在预设时间内转动预设角度。驱动折叠内管伸缩至指定长度，实现单个功能模块的移动、转向。