“乐高遥控小车”的版本间的差异
(→实验原理) |
(→程序说明) |
||
第196行: | 第196行: | ||
==程序说明== | ==程序说明== | ||
− | <source lang=cpp> | + | <source lang="cpp"> |
#include <mCookieLEGO.h> | #include <mCookieLEGO.h> | ||
#include <Microduino_Protocol_HardSer.h> | #include <Microduino_Protocol_HardSer.h> |
2016年4月25日 (一) 06:37的版本
Language | English |
---|
概述
材料清单
实验原理
程序下载
程序烧写
拼装过程
操作说明蓝牙遥控指南
疑难解答/FAQ
|
程序说明
#include <mCookieLEGO.h>
#include <Microduino_Protocol_HardSer.h>
#include "Wire.h"
uint16_t Data[8];
int speedLeft = 0;
int speedRight = 0;
Protocol ProtocolB(&Serial1, TYPE_NUM);
mCookieLEGO m;
void setup(){
Wire.begin();
Serial.begin(9600);
ProtocolB.begin(9600); //9600/19200/38400
m.configSensorType(mCookieLEGO::S1, mCookieLEGO::SENSOR_ULTRA);
m.configConnection(0xFFFF);
}
uint8_t dis;
void loop(){
int sta = ProtocolB.parse(Data, MODE_WHILE);
if (sta != P_NONE) {
switch (sta) {
case P_FINE:
speedLeft = map(Data[1], 1000, 2000, -255, 255);
speedRight = speedLeft;
int speedTurn = map(Data[4], 1000, 2000, -255, 255);
if(speedTurn < 0){
speedLeft += speedTurn;
}
else{
speedRight -= speedTurn;
}
break;
// default:
// break;
}
}
refreshSpeed();
delay(10);
}
void refreshSpeed{
m.motor_setFixedDrive(mCookieLEGO::M3, speedLeft);
m.motor_setFixedDrive(mCookieLEGO::M4, speedRight);
}