直立平衡机器人制造技术

技术编号:13913649 阅读:94 留言:0更新日期:2016-10-27 09:54
本发明专利技术公开了一种直立平衡机器人,包括机身,机身的内部设有加速度计、陀螺仪以及集成步进电机驱动单元的控制模块,机身下端的两侧设有两个滚轮,机身内部设有两组步进电机,机身的两侧设有活动臂,控制模块基于加速度计和陀螺仪的检测量经过滤波、计算后得到角度值和角速度值,利用角度值和角速度值进行PD控制产生两个用于控制电机转动的输出量,通过步进电机驱动单元控制步进电机工作。本发明专利技术通过控制两个电机的转动能够精确地控制机器人保持直立平衡;其整体为人形造型,具有仿生外形效果;控制模块集成有步进电机驱动单元,不需要设置传统的大电机驱动器,减小了机器人本身的体积,降低功耗;此机器人能够进一步配置使得具有娱乐功能。

【技术实现步骤摘要】

本专利技术涉及电子
,具体涉及一种可供教学使用的直立平衡机器人
技术介绍
现有技术中并无一种专门针对教学使用的专用直立机器人。因此,有必要开发一种相应的机器人产品,以供学生快速学习机器人技术使用。
技术实现思路
为了实现以上目的,本专利技术提供一种直立平衡机器人,其能够同时满足教学和娱乐的使用要求。本专利技术是通过以下技术方案实现的:直立平衡机器人,包括整体成直立状态的机身,机身的内部设有用于检测角度值的加速度计、用于检测角速度值的陀螺仪以及集成步进电机驱动单元的控制模块,机身下端的两侧设有用于与地面接触的两个滚轮,机身内部设有分别单独驱动两个滚轮转动的两组步进电机,所述机身的两侧设有受控制模块控制活动的活动臂,所述控制模块基于加速度计和陀螺仪的检测量经过滤波、计算后得到角度值和角速度值,利用角度值和角速度值进行PD控制产生两个用于控制电机转动的输出量,通过步进电机驱动单元控制步进电机工作。作为优选的实施方式,所述用于与外部通讯的无线数据传输模块,无线数据传输模块与控制模块电气连接。作为优选的实施方式,所述机身的外部设有温度传感器、湿度传感器、压力传感器和声音传感器,温度传感器、湿度传感器、压力传感器和声音传感器的输出端与控制模块连接。作为优选的实施方式,所述机身的外部设有用于感应其他机器人的感受传感器,感受传感器的输出端与控制模块连接。进一步,所述活动臂上安装有声光枪,机身正面感应到其他机器人时声光枪点亮。本专利技术的有益效果是:本专利技术通过控制两个电机的转动能够精确地控制机器人保持直立平衡;其整体为人形造型,具有仿生外形效果;控制模块集成有步进电机驱动单元,不需要设置传统的大电机驱动器,减小了机器人本身的体积,降低功耗;此机器人能够进一步配置使得具有娱乐功能。附图说明图1为本专利技术的整体外观结构图。图2为本专利技术的系统组成框图。符号说明:1-机身,2-滚轮,3-步进电机,4-活动臂,5-加速度计,6-陀螺仪,7-控制模块,8-无线数据传输模块,9-环境传感器,10-感受传感器。具体实施方式下面参照附图并结合实施例对本专利技术作进一步的描述。参照图1,本专利技术的直立平衡机器人整体为人形造型,外观上包括机身1、两个滚轮2以及两组分别用于控制滚轮2转动的步进电机3。机身1整体成直立状态。工作时,步进电机3控制两个滚轮2不同的转速实现机器人直立平衡移动和转动。另外,机身1的两侧还设有可活动的活动臂4,在控制下活动臂4能够实现各种动作。如图2所示,机器人内设有加速度计5、陀螺仪6、控制模块7等。加速度计5用于检测机身的角度值,陀螺仪6用于检测机身的角速度值。控制模块7内集成有步进电机驱动单元,因此控制模块7能够直接驱动步进电机3工作,不需要设置额外的驱动器。工作时,控制模块7基于加速度计5和陀螺仪6的检测量经过滤波、计算后得到角度值和角速度值,利用角度值和角速度值进行PD控制产生两个用于控制电机转动的输出量,通过步进电机驱动单元控制步进电机工作。实际机器人中使用的角度和角速度计算方法如下:float Angle = 0, Angle_dot = 0;float Q_angle=0.001, Q_gyro=0.003, R_angle=0.67, dt=0.0025;float P[2][2] ={{ 1, 0本文档来自技高网...

【技术保护点】
直立平衡机器人,其特征在于:包括整体成直立状态的机身,机身的内部设有用于检测角度值的加速度计、用于检测角速度值的陀螺仪以及集成步进电机驱动单元的控制模块,机身下端的两侧设有用于与地面接触的两个滚轮,机身内部设有分别单独驱动两个滚轮转动的两组步进电机,所述机身的两侧设有受控制模块控制活动的活动臂,所述控制模块基于加速度计和陀螺仪的检测量经过滤波、计算后得到角度值和角速度值,利用角度值和角速度值进行PD控制产生两个用于控制电机转动的输出量,通过步进电机驱动单元控制步进电机工作。

【技术特征摘要】
1.直立平衡机器人,其特征在于:包括整体成直立状态的机身,机身的内部设有用于检测角度值的加速度计、用于检测角速度值的陀螺仪以及集成步进电机驱动单元的控制模块,机身下端的两侧设有用于与地面接触的两个滚轮,机身内部设有分别单独驱动两个滚轮转动的两组步进电机,所述机身的两侧设有受控制模块控制活动的活动臂,所述控制模块基于加速度计和陀螺仪的检测量经过滤波、计算后得到角度值和角速度值,利用角度值和角速度值进行PD控制产生两个用于控制电机转动的输出量,通过步进电机驱动单元控制步进电机工作。2.根据权利要求1所述的直立平衡机器人,其...

【专利技术属性】
技术研发人员:李阳
申请(专利权)人:合肥仁德电子科技有限公司
类型:发明
国别省市:安徽;34

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1