主题:姿态传感器控制双直流电机转动
器件: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)未作规定处可自行处理,无明显与事实违背即可。
发表评论