[发明专利]一种基于IIC总线的模块化机器人及控制方法有效
申请号: | 202110307361.0 | 申请日: | 2021-03-23 |
公开(公告)号: | CN113119084B | 公开(公告)日: | 2023-06-02 |
发明(设计)人: | 齐鹏;潘湘辉;孙一洋;石卓凡;张长柱 | 申请(专利权)人: | 同济大学 |
主分类号: | B25J9/08 | 分类号: | B25J9/08;B25J9/16;B62D57/032 |
代理公司: | 上海科盛知识产权代理有限公司 31225 | 代理人: | 宣慧兰 |
地址: | 200092 *** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 iic 总线 模块化 机器人 控制 方法 | ||
1.一种基于IIC总线的模块化机器人的控制方法,其特征在于,机器人由多个基础单元机器人首尾相连组装形成,基础单元机器人之间通过IIC总线进行通讯连接,每个基础单元机器人包括连接部(1)和行走部,单个所述基础单元机器人通过连接部(1)与另外两个基础单元机器人进行相互连接,所述行走部活动连接于连接部(1)的侧面,受连接部(1)的供电与控制;
所述连接部(1)设有主体舵机、控制电路板、蓝牙通信模块和电源,所述控制电路板分别与舵机、蓝牙通信模块和电源连接;
所述行走部包括多个依次连接的行走节(2),每个行走节(2)上均设有运动舵机;
所述行走节(2)上的运动舵机相互连接,位于靠近连接部(1)的端部的行走节(2)的运动舵机分别与连接部(1)的控制电路板和电源连接;
控制方法包括以下步骤:
S1、每个基础单元机器人的控制电路板设置总线地址,根据设置完成的总线地址将相应的基础单元机器人作为主控模块,其余的基础单元机器人作为从控模块;
S2、主控模块的蓝牙通信模块接收应用程序发送的指令信号,并通过串口传送给主控模块的控制电路板;
S3、主控模块的控制电路板根据指令信号中的数据信息,计算得到主控模块的主控指令和所有从控模块的从控指令,通过IIC总线将从控指令发送到对应的从控模块的控制电路板;
S4、主控模块的控制电路板和从控模块的控制电路板分别根据主控指令和从控指令,计算得到主体舵机和运动舵机的舵机角度;
S5、主控模块和从控模块的控制电路板根据舵机角度计算出相应的舵机控制信号,主体舵机和运动舵机根据舵机控制信号控制行走节(2)进行移动;
所述连接部(1)的两端分别设有卡合部(3)与卡合配合部(4),通过卡合部(3)与另外的基础单元机器人的卡合配合部(4)活动连接,通过卡合配合部(4)与另外的基础单元机器人的卡合部(3)活动连接。
2.根据权利要求1所述的控制方法,其特征在于,所述行走部中位于末端的行走节(2)上设有支撑部(5)。
3.根据权利要求1所述的控制方法,其特征在于,所述主控模块和从控模块的控制电路板中设有PWM发生器。
4.根据权利要求3所述的控制方法,其特征在于,所述步骤S5中舵机控制信号具体为PWM发生器根据舵机角度生成的相应占空比的PWM波。
5.根据权利要求1所述的控制方法,其特征在于,所述步骤S1中控制电路板通过拨码开关来设定总线地址。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于同济大学,未经同济大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110307361.0/1.html,转载请声明来源钻瓜专利网。
- 上一篇:业务数据的获取方法、装置、计算机设备和存储介质
- 下一篇:一种钼酸洗工艺