-
Notifications
You must be signed in to change notification settings - Fork 0
/
Moving.cpp
69 lines (60 loc) · 1.12 KB
/
Moving.cpp
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
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
#include "Moving.h"
#include "API.h"
void Moving::Move() {
switch (m_turn)
{
case spat::turn::forward:
Forward();
break;
case spat::turn::right:
Right();
break;
case spat::turn::left:
Left();
break;
case spat::turn::back:
Back();
break;
case spat::turn::r90:
R90();
break;
case spat::turn::l90:
L90();
break;
case spat::turn::stop:
break;
default:
API::log("turn error!");
break;
}
}
void Moving::Forward() {
API::moveForward();
}
void Moving::Right() {
API::turnRight();
API::moveForward();
}
void Moving::Left() {
API::turnLeft();
API::moveForward();
}
void Moving::Back() {
API::turnRight();
API::turnRight();
API::moveForward();
}
void Moving::R90() {
API::moveForwardHalf();
API::turnRight45();
API::moveForwardHalf();
API::turnRight45();
API::moveForwardHalf();
}
void Moving::L90() {
API::moveForwardHalf();
API::turnLeft45();
API::moveForwardHalf();
API::turnLeft45();
API::moveForwardHalf();
}