Eduino/Robot.cpp at master · canrobot/Eduino · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
#include "Robot.h"

uint8_t DPlay_Robot::DPlay_Robot_Lpin1;
uint8_t DPlay_Robot::DPlay_Robot_Lpin2;
uint8_t DPlay_Robot::DPlay_Robot_Rpin1;
uint8_t DPlay_Robot::DPlay_Robot_Rpin2;

DPlay_Robot::DPlay_Robot(uint8_t Lpin1, uint8_t Lpin2, uint8_t Rpin1, uint8_t Rpin2) {
	DPlay_Robot_Lpin1 = Lpin1;
	DPlay_Robot_Lpin2 = Lpin2;
	DPlay_Robot_Rpin1 = Rpin1;
	DPlay_Robot_Rpin2 = Rpin2;
}

void DPlay_Robot::Front() {
     digitalWrite(DPlay_Robot_Lpin1, LOW);
     digitalWrite(DPlay_Robot_Lpin2, HIGH);
     digitalWrite(DPlay_Robot_Rpin1, HIGH);
     digitalWrite(DPlay_Robot_Rpin2, LOW);
}

void DPlay_Robot::Back() {
     digitalWrite(DPlay_Robot_Lpin1, HIGH);
     digitalWrite(DPlay_Robot_Lpin2, LOW);
     digitalWrite(DPlay_Robot_Rpin1, LOW);
     digitalWrite(DPlay_Robot_Rpin2, HIGH);
}

void DPlay_Robot::Left() {
     digitalWrite(DPlay_Robot_Lpin1, HIGH);
     digitalWrite(DPlay_Robot_Lpin2, LOW);
     digitalWrite(DPlay_Robot_Rpin1, HIGH);
     digitalWrite(DPlay_Robot_Rpin2, LOW);
}

void DPlay_Robot::Right() {
     digitalWrite(DPlay_Robot_Lpin1, LOW);
     digitalWrite(DPlay_Robot_Lpin2, HIGH);
     digitalWrite(DPlay_Robot_Rpin1, LOW);
     digitalWrite(DPlay_Robot_Rpin2, HIGH);
}

void DPlay_Robot::Break() {
     digitalWrite(DPlay_Robot_Lpin1, LOW);
     digitalWrite(DPlay_Robot_Lpin2, LOW);
     digitalWrite(DPlay_Robot_Rpin1, LOW);
     digitalWrite(DPlay_Robot_Rpin2, LOW);
}