CN106078739A - 直立平衡机器人 - Google Patents
直立平衡机器人 Download PDFInfo
- Publication number
- CN106078739A CN106078739A CN201610446679.6A CN201610446679A CN106078739A CN 106078739 A CN106078739 A CN 106078739A CN 201610446679 A CN201610446679 A CN 201610446679A CN 106078739 A CN106078739 A CN 106078739A
- Authority
- CN
- China
- Prior art keywords
- fuselage
- robot
- control
- control module
- angular velocity
- 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.)
- Withdrawn
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/003—Manipulators for entertainment
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- 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 |
---|---|---|---|
CN201610446679.6A CN106078739A (zh) | 2016-06-21 | 2016-06-21 | 直立平衡机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610446679.6A CN106078739A (zh) | 2016-06-21 | 2016-06-21 | 直立平衡机器人 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106078739A true CN106078739A (zh) | 2016-11-09 |
Family
ID=57237543
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610446679.6A Withdrawn CN106078739A (zh) | 2016-06-21 | 2016-06-21 | 直立平衡机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106078739A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108687768A (zh) * | 2018-04-02 | 2018-10-23 | 深圳臻迪信息技术有限公司 | 一种涉水机器人以及涉水机器人信息输入方法 |
WO2019018963A1 (zh) * | 2017-07-22 | 2019-01-31 | 深圳市萨斯智能科技有限公司 | 一种机器人移动速度控制方法和机器人 |
-
2016
- 2016-06-21 CN CN201610446679.6A patent/CN106078739A/zh not_active Withdrawn
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019018963A1 (zh) * | 2017-07-22 | 2019-01-31 | 深圳市萨斯智能科技有限公司 | 一种机器人移动速度控制方法和机器人 |
CN108687768A (zh) * | 2018-04-02 | 2018-10-23 | 深圳臻迪信息技术有限公司 | 一种涉水机器人以及涉水机器人信息输入方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101558435B (zh) | 驾驶模拟器 | |
CN102039589B (zh) | 模块化的灾害救援机器人 | |
CN106394715A (zh) | 一种全向移动轮式机器人平台及控制方法 | |
CN201927271U (zh) | 多功能教学用机器人 | |
CN208654640U (zh) | 两轮平衡机器人控制系统 | |
CN206154320U (zh) | 手臂运动姿态捕捉器及机器人手臂运动系统 | |
CN105242679A (zh) | 一种四旋翼飞行器的控制系统设计方法 | |
CN105094160A (zh) | 直立平衡机器人 | |
CN107450351A (zh) | 一种轮式机器人控制系统仿真系统及仿真方法 | |
CN107195219A (zh) | 一种电动操纵负荷系统、飞机飞行模拟系统和加载模拟操纵阻力的方法 | |
CN106078739A (zh) | 直立平衡机器人 | |
CN201525026U (zh) | 模块化的灾害救援机器人 | |
CN202976657U (zh) | 一种训练用自动行驶避障车 | |
CN105005303A (zh) | 直立平衡机器人 | |
CN103810929B (zh) | 平面二维自由度旋转倒立摆装置 | |
CN106094831A (zh) | 直立平衡机器人 | |
CN202622805U (zh) | 一种模拟三轴运动平台 | |
CN205540255U (zh) | 用于汽车转向器试验台的伺服电机闭环加载控制器 | |
CN104932508A (zh) | 直立平衡机器人 | |
CN106054885A (zh) | 直立平衡机器人 | |
CN206021083U (zh) | 一种电动平衡车车体姿态检测器 | |
CN110035870A (zh) | 机器人系统、位置关系取得装置及位置关系取得方法 | |
CN109571467B (zh) | 双轮差速机器人运动模型标定方法、装置及里程计系统 | |
CN203397604U (zh) | 智能教育用自动控制装置 | |
CN210864419U (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 | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20161109 |
|
WW01 | Invention patent application withdrawn after publication |