CN105094160A - 直立平衡机器人 - Google Patents
直立平衡机器人 Download PDFInfo
- Publication number
- CN105094160A CN105094160A CN201410653846.5A CN201410653846A CN105094160A CN 105094160 A CN105094160 A CN 105094160A CN 201410653846 A CN201410653846 A CN 201410653846A CN 105094160 A CN105094160 A CN 105094160A
- Authority
- CN
- China
- Prior art keywords
- robot
- fuselage
- control module
- angle
- vertical balanced
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Abstract
本发明公开了一种直立平衡机器人,包括机身,机身的内部设有加速度计、陀螺仪以及集成步进电机驱动单元的控制模块,机身下端的两侧设有两个滚轮,机身内部设有两组步进电机,机身的两侧设有活动臂,控制模块基于加速度计和陀螺仪的检测量经过滤波、计算后得到角度值和角速度值,利用角度值和角速度值进行PD控制产生两个用于控制电机转动的输出量,通过步进电机驱动单元控制步进电机工作。本发明通过控制两个电机的转动能够精确地控制机器人保持直立平衡;其整体为人形造型,具有仿生外形效果;控制模块集成有步进电机驱动单元,不需要设置传统的大电机驱动器,减小了机器人本身的体积,降低功耗;此机器人能够进一步配置使得具有娱乐功能。
Description
技术领域
本发明涉及电子技术领域,具体涉及一种可供教学使用的直立平衡机器人。
背景技术
现有技术中并无一种专门针对教学使用的专用直立机器人。因此,有必要开发一种相应的机器人产品,以供学生快速学习机器人技术使用。
发明内容
为了实现以上目的,本发明提供一种直立平衡机器人,其能够同时满足教学和娱乐的使用要求。
本发明是通过以下技术方案实现的:
直立平衡机器人,包括整体成直立状态的机身,机身的内部设有用于检测角度值的加速度计、用于检测角速度值的陀螺仪以及集成步进电机驱动单元的控制模块,机身下端的两侧设有用于与地面接触的两个滚轮,机身内部设有分别单独驱动两个滚轮转动的两组步进电机,所述机身的两侧设有受控制模块控制活动的活动臂,所述控制模块基于加速度计和陀螺仪的检测量经过滤波、计算后得到角度值和角速度值,利用角度值和角速度值进行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控制产生两个用于控制电机转动的输出量,通过步进电机驱动单元控制步进电机工作。
实际机器人中使用的角度和角速度计算方法如下:
floatAngle=0,Angle_dot=0;
floatQ_angle=0.001,Q_gyro=0.003,R_angle=0.67,dt=0.0025;
floatP[2][2]={{1,0},{0,1}};
charC_0=1;
floatE=0;
floatq_bias=0;
floatAngle_err=0;
floatPCt_0=0,PCt_1=0;
floatK_0=0,K_1=0;
floatt_0=0,t_1=0;
floatPdot[4]={0,0,0,0};
voidfilter(floatangle_m,floatgyro_m)
{
Angle+=(gyro_m-q_bias)*dt;
Pdot[0]=Q_angle-P[0][1]-P[1][0];
Pdot[1]=-P[1][1];
Pdot[2]=-P[1][1];
Pdot[3]=Q_gyro;
P[0][0]+=Pdot[0]*dt;
P[0][1]+=Pdot[1]*dt;
P[1][0]+=Pdot[2]*dt;
P[1][1]+=Pdot[3]*dt;
Angle_err=angle_m-Angle;
PCt_0=C_0*P[0][0];
PCt_1=C_0*P[1][0];
E=R_angle+C_0*PCt_0;
K_0=PCt_0/E;
K_1=PCt_1/E;
t_0=PCt_0;
t_1=C_0*P[0][1];
P[0][0]-=K_0*t_0;
P[0][1]-=K_0*t_1;
P[1][0]-=K_1*t_0;
P[1][1]-=K_1*t_1;
Angle+=K_0*Angle_err;
q_bias+=K_1*Angle_err;
Angle_dot=gyro_m-q_bias;
}
其中,函数形参为传感器测得元数据(经过单位变换),Angle和Angle_dot为最终滤波输出结果,分别为角度和角速度。dt为滤波器采样时间,其余均为中间变量。
在得到了具体的角度和角速度信息后,采用典型的PD控制产生输出量。
duty_PD=Kp_Angle*Angle_Err+Kd_Angle*Angle_V;
其中Angle_Err为角度偏差,Angle_V为角速度。
再仔细调整Kp_Angle和Kd_Angle,机器人便可以实现直立。
本发明的机器人可以通过内置更多的模块以实现更好的教学和娱乐功能。
例如,机身内可以设有用于与外部通讯的无线数据传输模块8,无线数据传输模块8与控制模块7电气连接。利用此无线数据传输模块8可以方便地与外部进行通讯,外部可以向机器人传输控制命令,控制机器人动作。
又例如,机身的外部可以设有温度传感器、湿度传感器、压力传感器和声音传感器等环境传感器9,温度传感器、湿度传感器、压力传感器和声音传感器的输出端与控制模块7连接。利用上述各种传感器可以对机器人所处环境进行检测,检测的数据送到控制模块7内,从而控制机器人实现各种动作。另外,这些数据也可以通过无线数据传输模块8向外传输,起到利用机器人探测环境的作用。
再例如,机身的外部可以设有用于感应其他机器人的感受传感器10,感受传感器10的输出端与控制模块7连接。当机器人感应到其他机器人时可以做出相应的相应动作。如活动臂上安装有声光枪,机身正面感应到其他机器人时声光枪点亮,以实现模拟对战的功能。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.直立平衡机器人,其特征在于:包括整体成直立状态的机身,机身的内部设有用于检测角度值的加速度计、用于检测角速度值的陀螺仪以及集成步进电机驱动单元的控制模块,机身下端的两侧设有用于与地面接触的两个滚轮,机身内部设有分别单独驱动两个滚轮转动的两组步进电机,所述机身的两侧设有受控制模块控制活动的活动臂,所述控制模块基于加速度计和陀螺仪的检测量经过滤波、计算后得到角度值和角速度值,利用角度值和角速度值进行PD控制产生两个用于控制电机转动的输出量,通过步进电机驱动单元控制步进电机工作。
2.根据权利要求1所述的直立平衡机器人,其特征在于:所述用于与外部通讯的无线数据传输模块,无线数据传输模块与控制模块电气连接。
3.根据权利要求1所述的直立平衡机器人,其特征在于:所述机身的外部设有温度传感器、湿度传感器、压力传感器和声音传感器,温度传感器、湿度传感器、压力传感器和声音传感器的输出端与控制模块连接。
4.根据权利要求1所述的直立平衡机器人,其特征在于:所述机身的外部设有用于感应其他机器人的感受传感器,感受传感器的输出端与控制模块连接。
5.根据权利要求4所述的直立平衡机器人,其特征在于:所述活动臂上安装有声光枪,机身正面感应到其他机器人时声光枪点亮。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410653846.5A CN105094160A (zh) | 2014-11-18 | 2014-11-18 | 直立平衡机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410653846.5A CN105094160A (zh) | 2014-11-18 | 2014-11-18 | 直立平衡机器人 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105094160A true CN105094160A (zh) | 2015-11-25 |
Family
ID=54574831
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410653846.5A Pending CN105094160A (zh) | 2014-11-18 | 2014-11-18 | 直立平衡机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105094160A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105005303A (zh) * | 2015-06-01 | 2015-10-28 | 安徽禄讯电子科技有限公司 | 直立平衡机器人 |
CN106990783A (zh) * | 2017-04-21 | 2017-07-28 | 歌尔科技有限公司 | 一种控制双轮机器人直线行走的方法和系统 |
CN107077139A (zh) * | 2016-02-25 | 2017-08-18 | 深圳市创客工场科技有限公司 | 智能机器人 |
CN109991989A (zh) * | 2017-12-29 | 2019-07-09 | 深圳市优必选科技有限公司 | 机器人空闲状态下的动态平衡方法、装置及存储介质 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006338580A (ja) * | 2005-06-06 | 2006-12-14 | Toyota Motor Corp | 移動ロボットの位置制御システムと位置制御方法 |
JP2007061962A (ja) * | 2005-08-31 | 2007-03-15 | Yaskawa Electric Corp | 移動型ロボットおよびその温度調整装置並びに温度調整方法 |
WO2008066273A1 (en) * | 2006-11-30 | 2008-06-05 | Electronics And Telecommunications Research Institute | Apparatus and method for detecting posture of robot |
CN201073550Y (zh) * | 2007-04-19 | 2008-06-18 | 复旦大学 | 一种具有丰富运动自由度的智能服务机器人 |
US20090102643A1 (en) * | 2007-10-22 | 2009-04-23 | Infineon Technologies Ag | Secure sensor/actuator systems |
CN201927271U (zh) * | 2011-03-14 | 2011-08-10 | 黑龙江科技学院 | 多功能教学用机器人 |
CN103163882A (zh) * | 2011-12-11 | 2013-06-19 | 陕西亚泰电器科技有限公司 | 智能化自寻迹机器人小车无线遥控系统 |
CN103170962A (zh) * | 2013-03-08 | 2013-06-26 | 北京工业大学 | 桌面型双轮自平衡机器人 |
CN103770121A (zh) * | 2014-02-20 | 2014-05-07 | 西北工业大学 | 一种组合式面部表情仿真装置 |
CN103885448A (zh) * | 2014-03-28 | 2014-06-25 | 芜湖蓝宙电子科技有限公司 | 一种教学智能车控制系统 |
CN103970141A (zh) * | 2014-05-30 | 2014-08-06 | 芜湖蓝宙电子科技有限公司 | 一种教学用微缩智能直立车嵌入式控制系统及其方法 |
-
2014
- 2014-11-18 CN CN201410653846.5A patent/CN105094160A/zh active Pending
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006338580A (ja) * | 2005-06-06 | 2006-12-14 | Toyota Motor Corp | 移動ロボットの位置制御システムと位置制御方法 |
JP2007061962A (ja) * | 2005-08-31 | 2007-03-15 | Yaskawa Electric Corp | 移動型ロボットおよびその温度調整装置並びに温度調整方法 |
WO2008066273A1 (en) * | 2006-11-30 | 2008-06-05 | Electronics And Telecommunications Research Institute | Apparatus and method for detecting posture of robot |
CN201073550Y (zh) * | 2007-04-19 | 2008-06-18 | 复旦大学 | 一种具有丰富运动自由度的智能服务机器人 |
US20090102643A1 (en) * | 2007-10-22 | 2009-04-23 | Infineon Technologies Ag | Secure sensor/actuator systems |
CN201927271U (zh) * | 2011-03-14 | 2011-08-10 | 黑龙江科技学院 | 多功能教学用机器人 |
CN103163882A (zh) * | 2011-12-11 | 2013-06-19 | 陕西亚泰电器科技有限公司 | 智能化自寻迹机器人小车无线遥控系统 |
CN103170962A (zh) * | 2013-03-08 | 2013-06-26 | 北京工业大学 | 桌面型双轮自平衡机器人 |
CN103770121A (zh) * | 2014-02-20 | 2014-05-07 | 西北工业大学 | 一种组合式面部表情仿真装置 |
CN103885448A (zh) * | 2014-03-28 | 2014-06-25 | 芜湖蓝宙电子科技有限公司 | 一种教学智能车控制系统 |
CN103970141A (zh) * | 2014-05-30 | 2014-08-06 | 芜湖蓝宙电子科技有限公司 | 一种教学用微缩智能直立车嵌入式控制系统及其方法 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105005303A (zh) * | 2015-06-01 | 2015-10-28 | 安徽禄讯电子科技有限公司 | 直立平衡机器人 |
CN107077139A (zh) * | 2016-02-25 | 2017-08-18 | 深圳市创客工场科技有限公司 | 智能机器人 |
CN106990783A (zh) * | 2017-04-21 | 2017-07-28 | 歌尔科技有限公司 | 一种控制双轮机器人直线行走的方法和系统 |
CN106990783B (zh) * | 2017-04-21 | 2023-09-01 | 歌尔科技有限公司 | 一种控制双轮机器人直线行走的方法和系统 |
CN109991989A (zh) * | 2017-12-29 | 2019-07-09 | 深圳市优必选科技有限公司 | 机器人空闲状态下的动态平衡方法、装置及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Nawawi et al. | Real-time control of a two-wheeled inverted pendulum mobile robot | |
CN105094160A (zh) | 直立平衡机器人 | |
CN104772756A (zh) | 基于惯性测量单元的机械臂及其控制方法 | |
CN208654640U (zh) | 两轮平衡机器人控制系统 | |
CN105259888B (zh) | 一种挖掘机示教控制系统、方法及挖掘机 | |
CN203673431U (zh) | 一种运动轨迹虚拟装置 | |
CN109116860A (zh) | 三旋翼无人机的非线性鲁棒控制方法 | |
CN107168186A (zh) | 基于六轴组合传感器的四点自动调平系统及其工作方法 | |
CN202847850U (zh) | 一种自平衡机器人 | |
CN105005303A (zh) | 直立平衡机器人 | |
CN106078744B (zh) | 一种两轮自平衡机器人滑模自适应控制系统 | |
CN106125909A (zh) | 一种用于训练的动作捕捉系统 | |
CN104122098A (zh) | 无人自行车功能测试实验系统 | |
CN203483854U (zh) | 一种跟随式智能玩具小车 | |
CN106406308A (zh) | 移动方向控制装置及移动方向控制方法 | |
CN106502227A (zh) | 一种分布式控制高精度调平起竖控制系统及方法 | |
CN104932508A (zh) | 直立平衡机器人 | |
CN103810929B (zh) | 平面二维自由度旋转倒立摆装置 | |
CN204856212U (zh) | 一种四旋翼飞行系统 | |
CN108393882A (zh) | 机器人姿态控制方法及机器人 | |
CN106335584A (zh) | 一种双轮平衡车控制系统 | |
CN106078739A (zh) | 直立平衡机器人 | |
CN205679960U (zh) | 一种独轮自平衡智能教育机器人 | |
CN203397604U (zh) | 智能教育用自动控制装置 | |
CN204725501U (zh) | 体感机械臂舒适度检测装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20151125 |
|
RJ01 | Rejection of invention patent application after publication |