CN104932508A - 直立平衡机器人 - Google Patents
直立平衡机器人 Download PDFInfo
- Publication number
- CN104932508A CN104932508A CN201510436252.3A CN201510436252A CN104932508A CN 104932508 A CN104932508 A CN 104932508A CN 201510436252 A CN201510436252 A CN 201510436252A CN 104932508 A CN104932508 A CN 104932508A
- Authority
- CN
- China
- Prior art keywords
- robot
- control module
- fuselage
- stepper motor
- angle
- 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
Landscapes
- Manipulator (AREA)
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控制产生两个用于控制电机转动的输出量,通过步进电机驱动单元控制步进电机工作。
实际机器人中使用的角度和角速度计算方法如下:
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 },{ 0, 1 }};
char C_0 = 1;
float E = 0;
float q_bias = 0;
float Angle_err = 0;
float PCt_0 = 0, PCt_1 = 0;
float K_0 = 0, K_1 = 0;
float t_0 = 0, t_1 = 0;
float Pdot[4] ={0,0,0,0};
void filter(float angle_m,float gyro_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 |
---|---|---|---|
CN201510436252.3A CN104932508A (zh) | 2015-07-23 | 2015-07-23 | 直立平衡机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510436252.3A CN104932508A (zh) | 2015-07-23 | 2015-07-23 | 直立平衡机器人 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN104932508A true CN104932508A (zh) | 2015-09-23 |
Family
ID=54119712
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510436252.3A Pending CN104932508A (zh) | 2015-07-23 | 2015-07-23 | 直立平衡机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104932508A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106094831A (zh) * | 2016-07-13 | 2016-11-09 | 安徽禄讯电子科技有限公司 | 直立平衡机器人 |
CN107077139A (zh) * | 2016-02-25 | 2017-08-18 | 深圳市创客工场科技有限公司 | 智能机器人 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1394660A (zh) * | 2002-08-06 | 2003-02-05 | 哈尔滨工业大学 | 全自主型足球机器人及其智能控制系统 |
US20030032363A1 (en) * | 2001-08-07 | 2003-02-13 | Yoichiro Kawashiro | Dynamic skater toy |
CN201073550Y (zh) * | 2007-04-19 | 2008-06-18 | 复旦大学 | 一种具有丰富运动自由度的智能服务机器人 |
CN202438152U (zh) * | 2012-01-09 | 2012-09-19 | 南宁卓蓝电子科技有限公司 | 一种对唱舞蹈机器人 |
CN104759103A (zh) * | 2015-04-07 | 2015-07-08 | 黑龙江大学 | 多驱动遥控拳击模型机器人系统及该机器人系统的控制方法 |
CN105005303A (zh) * | 2015-06-01 | 2015-10-28 | 安徽禄讯电子科技有限公司 | 直立平衡机器人 |
-
2015
- 2015-07-23 CN CN201510436252.3A patent/CN104932508A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20030032363A1 (en) * | 2001-08-07 | 2003-02-13 | Yoichiro Kawashiro | Dynamic skater toy |
CN1394660A (zh) * | 2002-08-06 | 2003-02-05 | 哈尔滨工业大学 | 全自主型足球机器人及其智能控制系统 |
CN201073550Y (zh) * | 2007-04-19 | 2008-06-18 | 复旦大学 | 一种具有丰富运动自由度的智能服务机器人 |
CN202438152U (zh) * | 2012-01-09 | 2012-09-19 | 南宁卓蓝电子科技有限公司 | 一种对唱舞蹈机器人 |
CN104759103A (zh) * | 2015-04-07 | 2015-07-08 | 黑龙江大学 | 多驱动遥控拳击模型机器人系统及该机器人系统的控制方法 |
CN105005303A (zh) * | 2015-06-01 | 2015-10-28 | 安徽禄讯电子科技有限公司 | 直立平衡机器人 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107077139A (zh) * | 2016-02-25 | 2017-08-18 | 深圳市创客工场科技有限公司 | 智能机器人 |
WO2017143569A1 (zh) * | 2016-02-25 | 2017-08-31 | 深圳市创客工场科技有限公司 | 智能机器人 |
CN106094831A (zh) * | 2016-07-13 | 2016-11-09 | 安徽禄讯电子科技有限公司 | 直立平衡机器人 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Nawawi et al. | Real-time control of a two-wheeled inverted pendulum mobile robot | |
CN105404744B (zh) | 一种空间机械臂全状态动力学半物理仿真系统 | |
CN105094160A (zh) | 直立平衡机器人 | |
CN105259888B (zh) | 一种挖掘机示教控制系统、方法及挖掘机 | |
CN201594225U (zh) | 一种带动作识别功能的游戏手柄 | |
CN203673431U (zh) | 一种运动轨迹虚拟装置 | |
CN104772756A (zh) | 基于惯性测量单元的机械臂及其控制方法 | |
CN208654640U (zh) | 两轮平衡机器人控制系统 | |
CN105005303A (zh) | 直立平衡机器人 | |
CN203483854U (zh) | 一种跟随式智能玩具小车 | |
CN106502227A (zh) | 一种分布式控制高精度调平起竖控制系统及方法 | |
CN104932508A (zh) | 直立平衡机器人 | |
CN106406308A (zh) | 移动方向控制装置及移动方向控制方法 | |
CN202976657U (zh) | 一种训练用自动行驶避障车 | |
CN106078739A (zh) | 直立平衡机器人 | |
CN206795850U (zh) | 一种新型智能化控制人形机器人 | |
CN105799807A (zh) | 一种交叉足印竞走机器人 | |
CN205679960U (zh) | 一种独轮自平衡智能教育机器人 | |
CN204725501U (zh) | 体感机械臂舒适度检测装置 | |
CN103713635A (zh) | 一种基于单片机智能小车控制系统 | |
CN106094831A (zh) | 直立平衡机器人 | |
CN103111076B (zh) | 娱乐机器人腿部机构 | |
CN203720787U (zh) | 笔迹记录计算笔 | |
CN106054885A (zh) | 直立平衡机器人 | |
CN111347432A (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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20150923 |
|
WD01 | Invention patent application deemed withdrawn after publication |