您现在的位置:首页 > 技术支持技术支持

自平衡机器人的控制系统设计

发布时间:2015-01-06 13:26:14  来源:大电流电感厂家   查看:

3.3 控电感器图片制系统软件设计
自平衡机器人的控制系统需要实现以下功能:传感器信息处理和机器人姿态信息计算,电机控制PID算法实现和CAN口的数据处理。系统控制流程如图6所示。系统上电后从主函数开始执行。主函数负责初始化控制器的I/O口、CAN口、控制周期定时器、A/D转换器、各个中断接收数据和发送扁平型电感数据模块等。初始化完毕,控制周期定时器时间到后,传感器信息输入到A/D转换器中进行转换,计算机器人的倾倒角度和倾倒角速度;然后调用PID算法计算电机控制数据,并通过CAN口输出给电机驱动器。

3.4 速度PID控制算法
机器人采用经典的PID算法进行平衡控制。控制系统采用典型的双闭环控制结构和前馈控制方法。速度环路设计有利于提高电机输出速度精度。前馈控制主要是为了补偿电机转轴与车轮转动轴以及传动系统的间隙误差,这些误差是稳定的、可以测量的。当电机在正反转变换时,控制系统可以检测到变换方向,经过位置误差环节调整后把确定的偏差补偿量叠加到驱动器输出端。这样电机转动的角度在原理基础上增加了补偿量,机械误差得以修正。
采用PID控制算法公式如下:

其中,u(k)为当前调节器输出量;u(k-1)为上一次调节器输出量;△u(k)塑封电感器为当前控制增量;e(k)为当前控制误差量;Kp为比例系数;电感器生产厂家KI为积分系数;Kd为微分系数。PID控制算法流程如图7所示。图中,ε为调试过程中设定的误差值。

4 实 验
利用该控制方法,对原理样机进行了多次实验。实验中,在机器人正上方水平位置安装陀螺仪,以采集机器人的倾倒角度数据。实际测量角度信息随时间变化的曲线如图8所示。通过测得数据分析可以看到,机器人大致可以稳定在0°附近,最大偏差为±2°。

结 语
本文设计了以ATmage128单片机为控制核心,采用红外测距传感器监控的双轮自平衡机器人,并搭建实验平台进行了控制试验。实验结果表明,该机器人可以通过有效的控制保持在竖直状态,并且在一定的角度范围内达到平衡。

平面变压器厂家 | 平面电感厂家

基于Littelfuse的LED照明保护方案随着LED成本的不断下降,以及各国政府对节能环保的日益重视,LED灯的市场前景变得越来越广阔。高亮度LED灯已经出现在各种各样场合,从户外广告牌、电视LED背光灯到交通信号灯、机场跑道导航灯等等。LE

基于主从控制的静止变流器并联系统 1 引 言国外航空静止变流器目前已经系列化,单相静止变流器从50VA~6KVA有20个功率等级,三相静止变流器从150VA~12KVA有11个功率等级,其中基本模块有6个,最大功率为1kVA,功率密

全桥逆变方波尖峰各位大神好!请教大家一个问题,我用一个全桥驱动一个高频变压器,然后用高频变压器驱动一个RLC串联谐振电路,测得H桥的四个功率管方波信号均没有尖峰,但测得高频变压器输出方波边沿

CopyRight2014
大电流电感 | 大功率电感 | 扁平线圈电感 注塑加工厂