一种轮足机器人驱动控制方法及系统

摘要: 本发明属于轮足机器人领域,尤其涉及一种轮足机器人驱动控制方法及系统。背景技术:1、轮足机器人结合了轮式机器人在平坦地面上高速、高效运行的优势,以及足式机器人在复...
一种轮足机器人驱动控制方法及系统

本发明属于轮足机器人领域,尤其涉及一种轮足机器人驱动控制方法及系统。

背景技术:

1、轮足机器人结合了轮式机器人在平坦地面上高速、高效运行的优势,以及足式机器人在复杂地形环境中具备良好越障能力的特点,近年来在科研教学、智能制造、灾害救援及特种作业等领域受到广泛关注。随着嵌入式控制技术、电机驱动技术及多传感器融合算法的发展,轮足机器人正逐步向高动态性能、高环境适应性及高智能化方向演进。

2、目前,现有轮足机器人系统通常由上位机决策模块与底层驱动控制模块构成。其中,上位机负责路径规划、运动决策及高层控制算法,下位机负责执行电机驱动、姿态感知及实时控制任务。在实际应用中,底层驱动系统的性能直接影响整机的控制精度、响应速度及稳定性。然而,现有技术方案中,多数轮足机器人平台尤其是商业化平台普遍存在:底层控制接口封闭,灵活性不足,仅对用户开放线速度和角速度等高层控制接口,底层电机控制及传感器原始数据未对用户开放,限制了用户对控制策略和数据的深入研究;实时控制性能受限,部分现有驱动系统采用非确定性调度,导致控制频率不稳定,通信延迟较大,影响轮足机器人的实时性和控制精度;通信方式单一且拓展性差,现有驱动板多仅支持单一通信接口,在不同应用场景下难以灵活适配多种上位机平台,限制了系统的通用性和拓展能力。

技术实现思路

1、为了解决上述现有技术中存在的问题,本发明提供了一种轮足机器人驱动控制方法及系统,该方法通过构建开放式底层驱动架构,实现对无刷电机的力矩控制,并通过固定高频的实时控制机制,提高系统控制精度与响应速度,同时系统兼容多种通信接口以增强通用性与拓展性。

2、本发明提供了一种轮足机器人驱动控制方法,方法包括以下步骤:

3、s1、初始化系统并开启适用于单片机的实时操作系统(free real-timeoperating system, freertos),将定时器配置为10000hz频率触发模数转换中断,在数模转换完成中断中进行状态反馈和矢量控制算法。

4、s2、开启控制器局域网(controller area network, can)总线中断、通用异步收发传输器(universal asynchronous receiver/transmitter, uart)的dma功能,通用串行设备(universal serial bus, usb)接口,将接收到的消息转移至预设缓冲区或freertos的消息队列中。

5、s3、在freertos中创建消息解析任务和舵机控制任务,解析在s2中转移的消息;生成对应占空比的脉冲宽度调制(pulse width modulation, pwm)信号驱动舵机,以获得轮足机器人的控制目标,改变机器人的运动姿态。

6、进一步的,s1中,矢量控制算法包括:

7、s11、通过电流传感器采集无刷电机三相电流信号,并通过编码器获取电机转子位置和转速信息,对采集到的电流信号进行坐标变换,计算获得电机当前轴电流、轴电流以及电机实际转速。

8、s12、接收上位机下发的目标速度指令或目标力矩指令,并根据目标值与实际反馈值之间的误差进行比例积分(proportional integral,pi)控制运算,生成轴和轴目标电压分量。

9、s13、对所述轴和轴目标电压分量进行反park变换及空间矢量脉宽调制(spacevector pulse width modulation,svpwm)计算,生成对应三相脉冲宽度调制信号,驱动无刷电机运行。

10、进一步的,s2中,开启并使用can、uart和usb中断,包括:

11、s21、开启can接口、uart接口及usb接口的接收中断,在对应接收中断中仅执行数据接收与缓存转移操作,通过直接存储器访问(direct memory access,dma)或缓冲队列方式将接收到的数据转移至freertos消息队列中。

12、进一步的,s3中,在freertos中创建消息解析任务包括:

13、s31、创建消息解析任务,从freertos消息队列中读取在s2中接收到的通信数据,并对数据进行协议解析、数据校验及控制参数提取;

14、s32、根据解析得到的控制模式和目标参数,更新对应无刷电机或舵机的目标控制变量,包括目标速度、目标力矩、目标位置或目标角度;

15、本发明还提供了一种轮足机器人驱动控制系统,用于执行上述的一种轮足机器人驱动控制方法,系统包括如下模块:

16、控制模块:用于读取传感器模块数据,读取通信模块数据,控制驱动模块等。

17、驱动模块:用于驱动无刷电机和舵机,实现轮足机器人的运动。

18、传感器模块:用于采集电机电流、速度和位置信息,同时采集九轴传感器信息。

19、电源模块:用于适配不同器件的电压需求,为不同器件供电。

20、通信模块:用于与其他设备通信,获取上位机发送的消息。

21、进一步的,控制模块包括第一控制芯片u1.1和u1.2,第一控制芯片u1.2的引脚19连接第四电容c4,第一控制芯片u1.2的引脚32连接第五电容c5,第一控制芯片u1.2的引脚48连接第六电容c6,第一控制芯片u1.2的引脚64连接第七电容c7,第一控制芯片u1.2的引脚13连接第八和九电容c8和c9, 第一控制芯片u1.1的引脚31连接第十电容c10,第一控制芯片u1.1的引脚47连接第十电容c11。第一控制芯片u1.1的引脚5和引脚6连接第一无缘晶振x1和两颗协振电容第七电容c1、第八电容c2。第一控制芯片u1.1的引脚7连接第一电阻r1、第九电容c9和第一开关sw1组成的复位电路。第十五电阻r15连接在数字地和模拟地之间。

22、进一步的,驱动模块包括第二电机驱动芯片u2和第三电机驱动芯片u3,第二驱动芯片u2的引脚1和引脚2之间连接第十二电容c12,第二驱动芯片u2的引脚3连接第十三电容c13到12v电源,第二驱动芯片u2的引脚15引脚连接第十四电容c14,第二驱动芯片u2的引脚18连接到控制模块同时被第二电阻r2上拉,第三驱动芯片u3的外围电路与第二驱动芯片u2一样,仅修改了输入输出的端口,以分别控制两个无刷电机。

23、进一步的,传感器模块包括第四电流传感器u4、第五电流传感器u5、第六电流传感器u6、第七电流传感器u7和第二十三九轴传感器u23。第四电流传感器u4的第二引脚和第三引脚之间连接第三电阻r3,第四电流传感器u4的第五引脚连接电容c15,第五、第六、第七电流传感器与之同理。第二十三九轴传感器第八引脚连接第三十三和第三十四电容c33和c34,第二十三九轴传感器第十引脚连接第三十五电容c35,第二十三九轴传感器第十三引脚连接第三十六电容c36。

24、进一步的,电源模块包括第十一电源接口u11、第九降压芯片u9、第十降压芯片u10、第二十四降压芯片u24和第二十二电平转换芯片u22。第十一电源接口u11的第1引脚连接第一肖特基二极管d1后接电源、稳压二极管d2、第二十二电容c22和第二十三电容c23。第九降压芯片u9的第六引脚连接第四肖特基二极管d4和第一电感l1输出降压后的5v电压同时连接第二十五和第二十六电容c25和c26。第九降压芯片u9第一引脚和第六引脚之间连接第二十七和第二十八电容c27和c28。第一电感l1输出降压后的5v电压与第九降压芯片u9的第三引脚之间连接第二十九电容c29和第十二电阻r12,同时第三引脚连接第十三电阻r13。第九降压芯片u9的第四引脚连接第十一电阻r11后连接第九降压芯片u9的第五引脚、第二十四电容c24和第三肖特基二极管d3,同时d3继续连接12v电源。第十降压芯片u10的第一和第三引脚连接到第一电感l1输出降压后的5v,第十降压芯片u10的第五引脚输出降压后的3.3v电压,同时连接第三十电容c30、第三十一电容c31和第十四电阻r14后连接第一发光二极管led1。第二十四降压芯片u24第一引脚和第三引脚连接第一电感l1输出降压后的5v电压,同时连接第三十七电容c37,第二十四降压芯片u24第五引脚输出降压后的电压,同时连接第三十八电容c38。

25、进一步的,通信模块包括第八通信芯片u8、第一通信芯片usb1、第二十二电平转换芯片u22、第十二、十三、十四、十五、十六、十七、十八、十九、二十、二十一通信接口u12、u13、u14、u15、u16、u17、u18、u19、u20和u21。第八通信芯片u8第六和第七引脚之间连接第八电阻r8。第一通信芯片usb1第四和第十引脚分别连接第九和第十电阻r9和r10,同时第一通信芯片usb1第二和第十一引脚连接第五肖特基二极管d5。第二十二电平转换芯片u22第八引脚连接第十六电阻r16。第十四通信接口u14的第一和第四引脚之间连接第三十二电容c32。

26、本发明实例具有以下技术效果:

27、本发明通过构建开放式底层驱动控制架构,实现对轮足机器人无刷电机的直接力矩控制,并采用固定高频率的实时控制机制,提高系统的控制精度、动态响应速度及运行稳定性;同时,本发明提供的轮足机器人驱动控制系统兼容can总线、uart及usb等多种通信接口,并结合异步通信与实时任务解耦机制,实现多通信方式下的稳定数据交互,从而增强系统的通用性、扩展性及科研开放性。