发明名称 | 一种基于陀螺仪反馈的机器人舵机控制系统 | ||
摘要 | 一种基于陀螺仪反馈的机器人舵机控制系统,包括传感器模块、控制器模块、舵机模块和电源模块,传感器模块与舵机模块连接,传感器模块的输出端与控制器模块的AD接口连接,传感器模块通过AD接口与控制器模块的PID控制器模块的输入端相连;PID控制器模块的输出端与PWM信号产生模块的输入端连接,PWM信号产生模块的输出端经控制器模块的GPIO口与舵机模块连接。传感器模块采集角速度、角位移信息并转换为电压信号送入控制器模块,得到PID控制器模块输入信号,结合上位机控制信令或预设轨迹,经控制器模块分析处理产生驱动舵机的PWM信号,进行实时位置校准。本发明解决传统机器人舵机控制缺乏反馈调整,控制系统结构简单、性能优越在非线性系统上大打折扣问题。 | ||
申请公布号 | CN104808495A | 申请公布日期 | 2015.07.29 |
申请号 | CN201510250705.3 | 申请日期 | 2015.05.15 |
申请人 | 武汉工程大学 | 发明人 | 朱磊;刘昌辉;帅考;杨维荣 |
分类号 | G05B13/04(2006.01)I | 主分类号 | G05B13/04(2006.01)I |
代理机构 | 湖北武汉永嘉专利代理有限公司 42102 | 代理人 | 唐万荣;杨晓燕 |
主权项 | 一种基于陀螺仪反馈的机器人舵机控制系统,其特征在于,至少包括如下模块:传感器模块,用于在机器人运动过程中实时采集机器人舵机的角速度、角位移信息,并将采集的角速度、角位移信息转换成调理的模拟电压信号输出;控制器模块,包括PID控制器模块和PWM信号产生模块,所述PID控制器模块用于将传感器模块采集的样本参数进行处理,并转变成PID控制参数,PID控制器模块采用基于模糊混合逻辑控制的PID控制算法对PWM信号进行调节;PWM信号产生模块,用于产生舵机驱动的PWM信号,PWM信号通过控制器模块的GPIO口输出;上位机控制信令输入模块,用于实现上层控制信令的输入;舵机模块;电源模块,用于为系统提供电源;所述传感器模块与舵机模块连接,传感器模块的输出端与控制器模块的AD接口连接,传感器模块通过AD接口与控制器模块的PID控制器模块的输入端相连;PID控制器模块的输出端与PWM信号产生模块的输入端连接,PWM信号产生模块的输出端经控制器模块的GPIO口与舵机模块连接;上位机控制信令输入模块通过串口通信与控制器模块连接。 | ||
地址 | 430074 湖北省武汉市洪山区雄楚大街693号 |