View difference between Paste ID: 1gwLfTsx and 9P6F7K7b
SHOW: | | - or go back to the newest paste.
1
/*
2-
** MAZE PROGRAM USING FUNCTIONS
2+
** MAZE PROGRAM v2 USING FUNCTIONS
3
**
4
**By Sebastian1314 and Steve Von Fedak
5
**
6
*/
7
8
void turnRight(int timeInt)
9
{
10
  bMotorReflected[port2]= 1;
11
  motor[port2] = -123;
12
  motor[port3] = 126;
13
  wait1Msec(timeInt);
14
}
15
16
void turnLeft(int timeInt)
17
{
18
  bMotorReflected[port2]= 1;
19
  motor[port2] = 123;
20
  motor[port3] = -126;
21
  wait1Msec(timeInt);
22
}
23
24
void uTurn()
25
{
26
  bMotorReflected[port2]= 1;
27
  motor[port2] = 123;
28
  motor[port3] = -126;
29
  wait1Msec(850);
30
}
31
32
void moveStraight(int timeInt)
33
{
34
  bMotorReflected[port2]= 1;
35
  motor[port2] = 123;
36
  motor[port3] = 126;
37
  wait1Msec(timeInt);
38
}
39
40
void StopWait(int timeInt)
41
{
42
  motor[port2] = 0;
43
  motor[port3] = 0;
44
  wait1Msec(timeInt);
45
}
46
47
task main
48
{
49
  bMotorReflected[port2]= 1;
50
  StopWait(2000);
51
52
  moveStraight(1000);
53
  StopWait(1000);
54
55
  turnLeft(360);
56
  StopWait(1000);
57
58
  moveStraight(1150);
59
  StopWait(1000);
60
61
  turnRight(400);
62
  StopWait(1000);
63
64
  moveStraight(620);
65-
65+
66-
66+
67
  turnRight(420);
68
  StopWait(1000);
69
70
  moveStraight(500);
71
  StopWait(2000);
72
73
  uTurn();
74
  StopWait(1000);
75
76
  moveStraight(500);
77
  StopWait(1000);
78
79
  turnLeft(380);
80
  StopWait(1000);
81
82
  moveStraight(540);
83
  StopWait(1000);
84
85
  turnLeft(380);
86
  StopWait(1000);
87
88
  moveStraight(1150);
89
  StopWait(1000);
90
91
  turnRight(400);
92
  StopWait(1000);
93
94
  moveStraight(1000);
95
  StopWait(1000);
96
97
  uTurn();
98
  StopWait(1000);
99
}