File tree 9 files changed +30
-33
lines changed
pico_halfV2_STEP5_Straight
pico_halfV2_STEP7_P_control
pico_halfV2_STEP8_micromouse
9 files changed +30
-33
lines changed Original file line number Diff line number Diff line change 17
17
#define LED2 15
18
18
#define LED3 16
19
19
20
- #define SW_C 13
20
+ #define SW_L 13
21
21
#define SW_R 14
22
22
23
- int g_state_r, g_state_c ;
23
+ int g_state_r, g_state_l ;
24
24
25
25
void setup ()
26
26
{
@@ -30,27 +30,27 @@ void setup()
30
30
pinMode (LED2, OUTPUT);
31
31
pinMode (LED3, OUTPUT);
32
32
33
- pinMode (SW_C , INPUT);
33
+ pinMode (SW_L , INPUT);
34
34
pinMode (SW_R, INPUT);
35
35
36
- g_state_r = g_state_c = 0 ;
36
+ g_state_r = g_state_l = 0 ;
37
37
}
38
38
39
39
void loop ()
40
40
{
41
41
// put your main code here, to run repeatedly:
42
- while ( digitalRead (SW_C ) && digitalRead (SW_R)) {
42
+ while ( digitalRead (SW_L ) && digitalRead (SW_R)) {
43
43
continue ;
44
44
}
45
45
if (digitalRead (SW_R) == 0 ) {
46
46
digitalWrite (LED3, (++g_state_r) & 0x01 );
47
47
}
48
- if (digitalRead (SW_C ) == 0 ) {
49
- digitalWrite (LED2, (++g_state_c ) & 0x01 );
50
- digitalWrite (LED1, (g_state_c )&0x01 );
48
+ if (digitalRead (SW_L ) == 0 ) {
49
+ digitalWrite (LED2, (++g_state_l ) & 0x01 );
50
+ digitalWrite (LED1, (g_state_l )&0x01 );
51
51
}
52
52
delay (30 );
53
- while (!(digitalRead (SW_C ) && digitalRead (SW_R))) {
53
+ while (!(digitalRead (SW_L ) && digitalRead (SW_R))) {
54
54
continue ;
55
55
}
56
56
delay (30 );
Original file line number Diff line number Diff line change 17
17
#define LED2 15
18
18
#define LED3 16
19
19
20
- #define SW_C 13
20
+ #define SW_L 13
21
21
#define SW_R 14
22
22
23
23
#define BUZZER 40
@@ -87,7 +87,7 @@ void setup()
87
87
pinMode (LED2, OUTPUT);
88
88
pinMode (LED3, OUTPUT);
89
89
90
- pinMode (SW_C , INPUT);
90
+ pinMode (SW_L , INPUT);
91
91
pinMode (SW_R, INPUT);
92
92
93
93
ledcSetup (0 , 440 , 10 );
@@ -101,7 +101,7 @@ void setup()
101
101
void loop ()
102
102
{
103
103
// put your main code here, to run repeatedly:
104
- while ( digitalRead (SW_C ) & digitalRead (SW_R)) {
104
+ while ( digitalRead (SW_L ) & digitalRead (SW_R)) {
105
105
continue ;
106
106
}
107
107
if (digitalRead (SW_R) == 0 ) {
@@ -115,7 +115,7 @@ void loop()
115
115
}
116
116
setLED (g_mode);
117
117
}
118
- if (digitalRead (SW_C ) == 0 ) {
118
+ if (digitalRead (SW_L ) == 0 ) {
119
119
ledcWriteTone (0 , INC_FREQ);
120
120
delay (80 );
121
121
ledcWriteTone (0 , DEC_FREQ);
@@ -124,7 +124,7 @@ void loop()
124
124
delay (300 );
125
125
execByMode (g_mode);
126
126
}
127
- while (!(digitalRead (SW_C ) & digitalRead (SW_R))) {
127
+ while (!(digitalRead (SW_L ) & digitalRead (SW_R))) {
128
128
continue ;
129
129
}
130
130
delay (30 );
Original file line number Diff line number Diff line change 17
17
#define LED2 15
18
18
#define LED3 16
19
19
20
- #define SW_C 13
20
+ #define SW_L 13
21
21
#define SW_R 14
22
22
23
23
#define MOTOR_EN 12
@@ -97,7 +97,7 @@ void setup()
97
97
pinMode (LED2, OUTPUT);
98
98
pinMode (LED3, OUTPUT);
99
99
100
- pinMode (SW_C , INPUT);
100
+ pinMode (SW_L , INPUT);
101
101
pinMode (SW_R, INPUT);
102
102
103
103
// motor disable
@@ -132,7 +132,7 @@ void setup()
132
132
void loop ()
133
133
{
134
134
// put your main code here, to run repeatedly:
135
- while (digitalRead (SW_C ) & digitalRead (SW_R)) {
135
+ while (digitalRead (SW_L ) & digitalRead (SW_R)) {
136
136
continue ;
137
137
}
138
138
digitalWrite (MOTOR_EN, HIGH);
Original file line number Diff line number Diff line change 17
17
#define LED2 15
18
18
#define LED3 16
19
19
20
- #define SW_C 13
20
+ #define SW_L 13
21
21
#define SW_R 14
22
22
23
23
#define MOTOR_EN 12
@@ -106,7 +106,7 @@ void setup()
106
106
pinMode (LED2, OUTPUT);
107
107
pinMode (LED3, OUTPUT);
108
108
109
- pinMode (SW_C , INPUT);
109
+ pinMode (SW_L , INPUT);
110
110
pinMode (SW_R, INPUT);
111
111
112
112
// motor disable
@@ -141,7 +141,7 @@ void setup()
141
141
void loop ()
142
142
{
143
143
// put your main code here, to run repeatedly:
144
- while (digitalRead (SW_C ) & digitalRead (SW_R)) {
144
+ while (digitalRead (SW_L ) & digitalRead (SW_R)) {
145
145
continue ;
146
146
}
147
147
digitalWrite (MOTOR_EN, HIGH);
Original file line number Diff line number Diff line change 17
17
#define LED2 15
18
18
#define LED3 16
19
19
20
- #define SW_C 13
20
+ #define SW_L 13
21
21
#define SW_R 14
22
22
23
23
#define MOTOR_EN 12
@@ -159,7 +159,7 @@ void setup()
159
159
pinMode (LED2, OUTPUT);
160
160
pinMode (LED3, OUTPUT);
161
161
162
- pinMode (SW_C , INPUT);
162
+ pinMode (SW_L , INPUT);
163
163
pinMode (SW_R, INPUT);
164
164
165
165
// motor disable
@@ -220,7 +220,7 @@ void setup()
220
220
void loop ()
221
221
{
222
222
// put your main code here, to run repeatedly:
223
- while (digitalRead (SW_C ) & digitalRead (SW_R)) {
223
+ while (digitalRead (SW_L ) & digitalRead (SW_R)) {
224
224
continue ;
225
225
}
226
226
Original file line number Diff line number Diff line change @@ -147,9 +147,6 @@ void adjustMenu(void)
147
147
mode = incButton (mode, 7 , 1 );
148
148
break ;
149
149
case SW_LM:
150
- mode = decButton (mode, 1 , 7 );
151
- break ;
152
- case SW_CM:
153
150
okButton ();
154
151
if (execByModeAdjust (mode) == 1 ) {
155
152
return ;
Original file line number Diff line number Diff line change 9
9
#define BLED0 18
10
10
#define BLED1 17
11
11
12
- #define SW_C 13
12
+ #define SW_L 13
13
13
#define SW_R 14
14
14
15
15
#define SLED_F 2
30
30
#define PWM_L 46
31
31
32
32
#define SW_LM 1
33
- #define SW_CM 2
33
+ // #define SW_CM 2
34
34
#define SW_RM 4
35
35
36
36
#define BUZZER_CH 0
Original file line number Diff line number Diff line change @@ -107,7 +107,7 @@ void initAll(void)
107
107
pinMode (BLED0, OUTPUT);
108
108
pinMode (BLED1, OUTPUT);
109
109
110
- pinMode (SW_C , INPUT);
110
+ pinMode (SW_L , INPUT);
111
111
pinMode (SW_R, INPUT);
112
112
113
113
ledcSetup (0 , 440 , 10 );
@@ -247,11 +247,11 @@ unsigned char getSW(void)
247
247
} while (digitalRead (SW_R) == LOW);
248
248
ret |= SW_RM;
249
249
}
250
- if (digitalRead (SW_C ) == LOW) {
250
+ if (digitalRead (SW_L ) == LOW) {
251
251
do {
252
252
delay (20 );
253
- } while (digitalRead (SW_C ) == LOW);
254
- ret |= SW_CM ;
253
+ } while (digitalRead (SW_L ) == LOW);
254
+ ret |= SW_LM ;
255
255
}
256
256
return ret;
257
257
}
Original file line number Diff line number Diff line change @@ -48,7 +48,7 @@ void loop()
48
48
case SW_RM:
49
49
g_mode = incButton (g_mode, 15 , 1 );
50
50
break ;
51
- case SW_CM :
51
+ case SW_LM :
52
52
okButton ();
53
53
execByMode (g_mode);
54
54
break ;
You can’t perform that action at this time.
0 commit comments