[发明专利]直立平衡机器人

说明书

技术领域

本发明涉及电子技术领域，具体涉及一种可供教学使用的直立平衡机器人。

背景技术

现有技术中并无一种专门针对教学使用的专用直立机器人。因此，有必要开发一种相应的机器人产品，以供学生快速学习机器人技术使用。

发明内容

为了实现以上目的，本发明提供一种直立平衡机器人，其能够同时满足教学和娱乐的使用要求。

本发明是通过以下技术方案实现的：

直立平衡机器人，包括整体成直立状态的机身，机身的内部设有用于检测角度值的加速度计、用于检测角速度值的陀螺仪以及集成步进电机驱动单元的控制模块，机身下端的两侧设有用于与地面接触的两个滚轮，机身内部设有分别单独驱动两个滚轮转动的两组步进电机，所述机身的两侧设有受控制模块控制活动的活动臂，所述控制模块基于加速度计和陀螺仪的检测量经过滤波、计算后得到角度值和角速度值，利用角度值和角速度值进行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;