当前位置:首页 > 电源 > 电源
[导读]引 言 移动式机器人在各行各业具有广泛的应用,而轮式移动机器人由于具有结构简单、可控性强、成本低等优点,成为移动式机器人研究的一个主要方向。自平衡机器人采用水平布置的两轮结构,本身是一个不稳定体。也

引 言
    移动式机器人在各行各业具有广泛的应用,而轮式移动机器人由于具有结构简单、可控性强、成本低等优点,成为移动式机器人研究的一个主要方向。自平衡机器人采用水平布置的两轮结构,本身是一个不稳定体。也就是说,自平衡机器人在静止状态下,不能保持平衡,车体总是要向前或向后倾倒;而在运动状态下,可以通过一定的控制策略使它达到动态平衡。
    由于自平衡机器人具有内在不稳定性和结构灵活性,国内外机器人爱好者设计了多种结构、外观各异的自平衡机器人,尝试采用各种控制策略使其达到自平衡控制。通常这类机器人采用姿态传感器检测机器人车体的倾倒角度和倾倒角速度,根据当前机器人姿态控制伺服电机驱动电压的转向和转速,从而使机器人保持平衡。该方式制作的自平衡机器人虽然控制性能良好,但成本高,不适合广泛推广。本文设计的机器人尝试采用红外测距传感器测量车体与地面的距离,通过计算获取机器人的姿态信息,进而实现机器人的自平衡。


1 系统结构
    本文设计的自平衡机器人系统主要由机械行走装置、控制系统和传感器3部分组成,如图1所示。

    机械行走装置主要由车体平台、电机驱动器、直流无刷电机、齿轮减速机构和车轮组成。机器人采用48 V电池供电,通过DC-DC模块转换为5 V和24 V电压。其中,5 V提供给控制系统和传感器,24 V提供给电机驱动器。控制系统以ATmega128单片机为主控制芯片,通过SJA1000扩展CAN总线与电机驱动器通信。红外测距传感器的输出是与距离成正比的模拟电压值,输入到单片机的A/D采样端口进行处理,从而得到距离信息。机器人的系统结构框图如图2所示。

[!--empirenews.page--]

2 姿态信息获取
    机器人的姿态信息包括倾倒的角度和角速度。如图3所示,机器人左右两侧水平位置各安装有1个红外测距传感器,可以测量与地面之间的距离d1和d2。当机器人在竖直状态时,左右传感器距离差为零。当机器人倾倒时,距离差与倾倒角度θ成函数关系如下:
    sin θ=(d2-d1)/D

    其中,D为传感器之间的距离。机器人在竖直动态控制时倾倒角度范围较小,此时sinθ≈θ,即可由传感器的距离信息得到机器人的倾倒角度。角速度可以通过θ对时间求导获得。
    选用的红外测距传感器为Sharp公司的GP2D12,输出为0.4~2.4 V的模拟信号,对应的测量距离为10~80 cm。在同一温度下,传感器的输出与测量结果呈良好的线性关系,可以满足自平衡机器人的要求。


3 控制系统设计
3.1 机器人平衡控制原理
    当车体偏离平衡位置(竖直位置)向前倾斜时,传感器采集信息并传送到单片机进行计算和判断,车轮随之作出响应向前运动,将车体向平衡位置调整;同样当车体向后倾斜时,车轮将向后运动。这样机器人一直处在倾斜判断、运动调整的动态过程中,使车体始终保持在平衡位置附近,达到一种动态平衡。
3.2 控制系统硬件设计
    控制系统主芯片选用Atmel公司基于RISC结构的8位单片机ATmega128。它采用低功耗CMOS工艺;具有丰富的片上资源,包括4个定时器、4 KB的数据SRAM、128 KB的程序Flash、可外扩至64 KB的E2PROM和8个10位ADC通道;拥有UART、SPI、I2C、JTAG接口,方便外部扩展和传感器的接入。
3.2.1 传感信息输入电路
    传感器信号通过放大器引入,通过设置反馈电阻(R1和R2)和输出端电阻(R3和R4)的阻值可以使输入的电压值在要求的范围内。具体硬件电路如图4所示。

[!--empirenews.page--]

3.2.2 扩展CAN通信电路
    单片机与电机控制器采用CAN总线通信,CAN接口采用Philips公司的CAN物理层和链路层接口芯片SJA1000和PCA82C250。单片机直接控制SJA1000的AD0~AD7、ALE、INT引脚。SJA1000工作在Intel模式下,MODE脚接高电平,片选脚CS接地,始终处于选通状态。扩展CAN通信电路如图5所示。单片机对SJA1000的操作主要是对寄存器的操作:一方面,对SJA1000的模式寄存器、命令寄存器、状态寄存器、中断寄存器、中断允许寄存器、总线定时寄存器、输出控制寄存器、时钟分频计数器进行设置和检测;另一方面,对收发缓冲区进行读写,从而和CAN设备交换数据。

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

[!--empirenews.page--]

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

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

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

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

本站声明: 本文章由作者或相关机构授权发布,目的在于传递更多信息,并不代表本站赞同其观点,本站亦不保证或承诺内容真实性等。需要转载请联系该专栏作者,如若文章内容侵犯您的权益,请及时联系本站删除。
换一批
延伸阅读

9月2日消息,不造车的华为或将催生出更大的独角兽公司,随着阿维塔和赛力斯的入局,华为引望愈发显得引人瞩目。

关键字: 阿维塔 塞力斯 华为

加利福尼亚州圣克拉拉县2024年8月30日 /美通社/ -- 数字化转型技术解决方案公司Trianz今天宣布,该公司与Amazon Web Services (AWS)签订了...

关键字: AWS AN BSP 数字化

伦敦2024年8月29日 /美通社/ -- 英国汽车技术公司SODA.Auto推出其旗舰产品SODA V,这是全球首款涵盖汽车工程师从创意到认证的所有需求的工具,可用于创建软件定义汽车。 SODA V工具的开发耗时1.5...

关键字: 汽车 人工智能 智能驱动 BSP

北京2024年8月28日 /美通社/ -- 越来越多用户希望企业业务能7×24不间断运行,同时企业却面临越来越多业务中断的风险,如企业系统复杂性的增加,频繁的功能更新和发布等。如何确保业务连续性,提升韧性,成...

关键字: 亚马逊 解密 控制平面 BSP

8月30日消息,据媒体报道,腾讯和网易近期正在缩减他们对日本游戏市场的投资。

关键字: 腾讯 编码器 CPU

8月28日消息,今天上午,2024中国国际大数据产业博览会开幕式在贵阳举行,华为董事、质量流程IT总裁陶景文发表了演讲。

关键字: 华为 12nm EDA 半导体

8月28日消息,在2024中国国际大数据产业博览会上,华为常务董事、华为云CEO张平安发表演讲称,数字世界的话语权最终是由生态的繁荣决定的。

关键字: 华为 12nm 手机 卫星通信

要点: 有效应对环境变化,经营业绩稳中有升 落实提质增效举措,毛利润率延续升势 战略布局成效显著,战新业务引领增长 以科技创新为引领,提升企业核心竞争力 坚持高质量发展策略,塑强核心竞争优势...

关键字: 通信 BSP 电信运营商 数字经济

北京2024年8月27日 /美通社/ -- 8月21日,由中央广播电视总台与中国电影电视技术学会联合牵头组建的NVI技术创新联盟在BIRTV2024超高清全产业链发展研讨会上宣布正式成立。 活动现场 NVI技术创新联...

关键字: VI 传输协议 音频 BSP

北京2024年8月27日 /美通社/ -- 在8月23日举办的2024年长三角生态绿色一体化发展示范区联合招商会上,软通动力信息技术(集团)股份有限公司(以下简称"软通动力")与长三角投资(上海)有限...

关键字: BSP 信息技术
关闭
关闭