matlab循迹小车,Arduino智能小车系列教程6——循迹小车

#include

#define STOP 0

#define FORWARD 1

#define BACKWARD 2

#define TURNLEFT 3

#define TURNRIGHT 4

int leftMotor1 = 16;

int leftMotor2 = 17;

int rightMotor1 = 18;

int rightMotor2 = 19;

int trac1 = 10; //从车头方向的最右边开始排序

int trac2 = 11;

int trac3 = 12;

int trac4 = 13;

int leftPWM = 5;

int rightPWM = 6;

Servo myServo; //舵机

int inputPin=7; // 定义超声波信号接收接口

int outputPin=8; // 定义超声波信号发出接口

void setup() {

// put your setup code here, to run once:

//串口初始化

Serial.begin(9600);

//舵机引脚初始化

myServo.attach(9);

//测速引脚初始化

pinMode(leftMotor1, OUTPUT);

pinMode(leftMotor2, OUTPUT);

pinMode(rightMotor1, OUTPUT);

pinMode(rightMotor2, OUTPUT);

pinMode(left