机器人编程六级 题库
主题:姿态传感器控制双直流电机转动
器件:ESP32主控1块、MPU6050姿态传感器模块1个、直流电机2个(分别为电机A和电机B)、直流电机驱动器及相关器件,以上模块也可以采用分立器件结合面包板进行搭建。
任务要求:
获取MPU6050姿态传感器的姿态角,使用俯仰角和滚转角控制两个直流电机的转速、转向和启停。具体要求如下:
(1)将当前姿态传感器的俯仰角和滚转角分别输出到串口监视器。
(2)当俯仰角的角度值位于-10~10度间时,直流电机处于停止状态。
(3)当俯仰角的角度值位于-80~-10度间时,直流电机正转,直流电机的转速随着倾角的增大而增大,随着倾角的减小而减慢。
(4)当俯仰角的角度值位于10~80度间时,直流电机反转,直流电机的转速随着倾角的增大而增大,随着倾角的减小而减慢。
(5)当滚转角的角度值位于-10~10度间时,直流电机启停不做变化。
(6)当滚转角的角度值小于-10度时,电机A停止转动,电机B保持原有状态不变。
(7)当滚转角的角度值大于10度时,电机B停止转动,电机A保持原有状态不变。
(8)程序采用Arduino C/C++代码编写。
(9)MPU6050姿态传感器的数据读取可以调用类库。直流电机的控制不得调用类库。
(10)程序编写过程中不得打开库例程和其它程序,如发现,实操成绩按照0分处理。
(11)未作规定处可自行处理,无明显与事实违背即可。
说明:请考生在考试结束前,按照如下要求提交相关文件:
(1)将程序放在一个文件夹中,并将文件夹命名为:DJKS6_身份证号;
(2)将程序文件夹压缩为1个“rar或zip”格式文件,大小5M以下;
(3)将程序文件通过“上传附件”按钮进行上传。
参考资料:
教材所使用类库MPU6050_tockn-1.5.2的例程如下,供参考。

评分组成
实操题总分100分,由两部分组成,分别为:电路搭设和功能实现。其中电路搭设分值20分,功能实现80分。
1、电路搭设(20分)
元器件:
(1)装置中包含2个直流电机及直流电机驱动模块;(4分)
(2)装置中包含MPU6050姿态传感器;(4分)
电路搭设:
(3)MPU6050姿态传感器与主控板正确连接;(4分)
(4)直流电机驱动模块与主控板正确连接;(4分)
(5)直流电机与电机驱动模块正确连接。(4分)
2、功能实现(80分)
(1)实现将当前姿态传感器的俯仰角和滚转角分别输出到串口监视器;(20分)
(2)实现当俯仰角的角度值位于-10~10度间时,直流电机处于停止状态;(10分)
(3)实现当俯仰角的角度值位于-80~-10度间时,直流电机正转,直流电机的转速随着倾角的增大而增大,随着倾角的减小而减慢;(15分)
(4)实现当俯仰角的角度值位于10~80度间时,直流电机反转,直流电机的转速随着倾角的增大而增大,随着倾角的减小而减慢;(15分)
(5)实现当滚转角的角度值小于-10度时,电机A停止转动,电机B的转速和转向随着俯仰角的变化而变化;(10分)
(6)当滚转角的角度值大于10度时,电机B停止转动,电机A的转速和转向随着俯仰角的变化而变化。(10分)
主题:姿态传感器控制直流电机转动
通过MPU6050姿态传感器控制直流电机的转动速度和方向。
器件:ESP32主控板、MPU6050姿态传感器模块1个、直流电机1个、直流电机驱动器1个、按键模块1个及相关器件,以上部件均可采用分立器件。
要求:
1、通过按键开关控制整个装置的运行,当第一次按下按键时,装置启动,板载LED灯点亮;当再次按下按键时,装置停止运行,板载LED灯熄灭,依此反复。
2、通过MPU6050姿态传感器的姿态角控制直流电机的转动,考生自行决定采用俯仰角、偏航角、滚转角其中之一来控制直流电机的转动。并将当前所采用姿态角的数值和电机转速的PWM值输出到串口监视器。
3、当姿态角的角度值为-10~10度时,直流电机处于停止状态。
4、当姿态角的角度值为-90~-10度时,直流电机正转,直流电机的转速随着倾角的增大而增大,随着倾角的减小而减慢。
5、当姿态角的角度值为10~90度时,直流电机反转,直流电机的转速随着倾角的增大而增大,随着倾角的减小而减慢。
6、程序采用C代码编写。MPU6050姿态传感器的数据读取可以调用类库。直流电机的控制不得调用类库
7、未作规定处可自行处理,无明显与事实违背即可。
8、编写程序文件命名规则为:DJKS6_身份证号,考试完毕拷贝上交备案。
9、程序编写过程中不得打开库例程和其它程序,如发现,实操成绩按照0分处理。
参考资料:
教材所使用类库MPU6050_tockn-1.5.2的例程如下,供参考。

评分组成
实操题总分100分,由两部分组成,分别为:电路搭设和功能呈现。其中电路搭设分值20分,功能呈现80分。
电路搭设评分 -- 总分20分
原器件:
1、装置中包含直流电机及直流电机驱动模块,得4分
2、装置中包含MPU6050姿态传感器,得4分
3、装置中包含按键模块,得4分
电路搭设:
4、MPU6050姿态传感器与主控板正确连接,得4分
5、直流电机驱动模块与主控板正确连接,得4分
功能呈现评分 -- 总分80分
1、实现当第一次按下按键时,LED灯点亮,装置启动,得10分。
2、实现将控制用姿态角的数值和直流电机的PWM值输出到串口监视器,得10分。
3、实现当姿态角的角度值为-10~10度时,直流电机处于停止状态,得10分。
4、实现当姿态角的角度值为-90~-10度时,直流电机正转,得10分。
5、实现当直流电机正转时,直流电机的转速随着倾角的增大而增大,随着倾角的减小而减慢,得10分。
6、实现当姿态角的角度值为10~90度时,直流电机反转,得10分。
7、实现当直流电机反转时,直流电机的转速随着倾角的增大而增大,随着倾角的减小而减慢,得10分。
8、实现当再次按下按键时,LED灯熄灭,装置停止运行,得10分。
主题:姿态传感器交互步进电机方向指示
器件:ESP32主控、按键模块、MPU6050模块、步进电机驱动模块、步进电机及相关辅件。以上模块也可以采用分立器件结合面包板进行搭建。
任务要求:通过MPU6050姿态传感器获取俯仰角和滚转角,根据俯仰角和滚转角的数值控制步进电机的转动,通过与步进电机转动轴垂直的连接件实现上、下、左、右方向指示功能。具体任务要求如下:
(1) 装置通电启动后,步进电机处于静止状态;
(2) 点击按键,步进电机开始自检。自检方式为:步进电机顺时针转动90度后停止,然后逆时针旋转180度后停止,再顺时针旋转90度回到初始位置后停止。自检完毕,装置进入工作状态;
(3) 沿X轴转动MPU6050模块,当转动角度大于45度时,步进电机转轴连接件指向向上或向下的MPU6050的旋转方向;
(4) 沿Y轴转动MPU6050模块,当滚转角大于45度时,步进电机转轴连接件指向向左或向右的MPU6050的旋转方向;
(5) 当MPU6050模块水平放置时,步进电机的在-45~45度之间循环摆动;
(6) 控制程序采用Arduino C/C++代码编写,不得使用图形化软件编写;
(7) 未作规定处可自行处理,无明显与事实违背即可。
说明:程序编写过程中不得打开其它示例程序,如发现,实操成绩按照0分处理。
请考生在考试结束前,按照如下要求提交相关文件。
(1) 将程序放在一个文件夹中,压缩为1个“rar或zip”格式文件,并命名为:DJKS6_身份证号,大小5M以下;
(2) 将程序文件通过“上传附件”按钮进行上传。
参考资料:
(1) 教材所使用类库MPU6050_tockn-1.5.2的例程如下,供参考。
#include<MPU6050_tockn.h>
#include<Wire.h>
MPU6050mpu6050(Wire);
voidsetup() {
Serial.begin(9600);
Wire.begin();
mpu6050.begin();
mpu6050.calcGyroOffsets(true);
}
voidloop() {
mpu6050.update();
Serial.print("angleX : ");
Serial.print(mpu6050.getAngleX());
Serial.print("\tangleY : ");
Serial.print(mpu6050.getAngleY());
Serial.print("\tangleZ : ");
Serial.println(mpu6050.getAngleZ());
}
(2) AccelStepper类库头文件和相关类库函数如下,供参考。
头文件:AccelStepper.h
类库对象:AccelStepper(mode, pin1,pin2,pin3,pin4)
成员函数:
setAcceleration(val); //设置步进电机转动时的加速度
setMaxSpeed(val); //设置步进电机转动的最大允许速度
setSpeed(val); //设置步进电机恒定转动时的速度值
runSpeed(); //启动步进电机以设定的速度值恒定转动
currentPosition(); //返回当前的位置值
moveTo(val); //设置步进电机运转的目标位置
run(); //启动步进电机按照设定的加速度和最大速度运转
setCurrentPosition(val); //设置当前位置为指定值
distanceToGo(val); //返回当前位置到目标位置之间的脉冲数}
评分项:
1. 器件及器件连接(20分)
2. 功能实现(80分)
(1) 装置通电启动后,步进电机处于静止状态;(5分)
(2) 点击按键,步进电机完成自检动作;(20分)
(3) 实现沿X轴转动MPU6050模块,当姿态角大于45度时,步进电机转轴连接件指向向上(或向下)的方向;(10分)
(4) 实现沿X轴转动MPU6050模块,当姿态角小于-45度时,步进电机转轴连接件指向向下(或向上)的方向;(10分)
(5) 实现沿Y轴转动MPU6050模块,当滚转角大于45度时,步进电机转轴连接件指向向左(或向右)的方向;(10分)
(6) 实现沿Y轴转动MPU6050模块,当滚转角小于-45度时,步进电机转轴连接件指向向右(或向左)的方向;(10分)
(7) 实现当MPU6050模块水平放置时,步进电机的在-45~45度之间循环摆动。(15分)
(1).DJKS6_650103201234186043.zip
暂无