-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathLinky.h
368 lines (307 loc) · 8.05 KB
/
Linky.h
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
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
/*
Linky.h - CoDrone library
Copyright (C) 2014 RoboLink. All rights reserved.
LastUpdate : 2018-04-27
*/
#ifndef Linky_h
#define Linky_h
#include "Arduino.h"
#include <avr/interrupt.h>
#include <EEPROM.h>
//----------------------------------------------------------------------------//
#define EEP_MOTOR_SPEED 25
#define EEP_REMOCON_CHANNEL 26
#define EEP_MOTOR_OFFSET_L 27
#define EEP_MOTOR_OFFSET_R 28
#define EEP_LINE_SEN_BASE_LH 21
#define EEP_LINE_SEN_BASE_LL 22
#define EEP_LINE_SEN_BASE_RH 23
#define EEP_LINE_SEN_BASE_RL 24
#define EEP_FIRST_START_CHECK1 30
#define EEP_FIRST_START_CHECK2 31
#define EEP_FIRST_START_CHECK3 32
#define EEP_FIRST_START_CHECK4 33
#define AVOID 1
#define LINE_TRACER 2
#define CLIFF_BOT 3
#define UNPLUGGED 4
#define FIRMATA 5
#define MAZE_BOT 6
#define AIN1 3
#define AIN2 7
#define BIN1 6
#define BIN2 8
#define IR_PIN 2 //ir receiver
#define MELODY_PIN 4 //buzzer
#define MIC_PIN A7 //MIC
#define BATCHECK_PIN A6 //BAT CHECK
//sensor pin (SFL ~ SBR)
#define SFL A0 // left ir sensor
#define SFF A1 // front ir sensor
#define SFR A2 // right ir sensor
#define SBL A3 // bottom left ir sensor
#define SBR A4 // bottom right ir sensor
// Switch
#define SW1 19
#define SW2 5
// power check resistor
#define R1 2200.0
#define R2 1000.0
#define LED_RED 10
#define LED_BLUE 9
#define LED_GREEN 11
#define MX_SP 100
#define MX_BR 100
//----------------------------------------------------------------------------//
#define LED_RED_ON digitalWrite(LED_RED, HIGH)
#define LED_GREEN_ON digitalWrite(LED_GREEN, HIGH)
#define LED_BLUE_ON digitalWrite(LED_BLUE, HIGH)
#define LED_RED_OFF digitalWrite(LED_RED, LOW)
#define LED_GREEN_OFF digitalWrite(LED_GREEN, LOW)
#define LED_BLUE_OFF digitalWrite(LED_BLUE, LOW)
//----------------------------------------------------------------------------//
//----------------------------------------------------------------------------//
// DC
//----------------------------------------------------------------------------//
#define CW 1
#define CCW 2
#define STOP 3
#define LOOSE 4
#define FORWARD 1
#define BACKWARD 2
#define LEFT 5
#define RIGHT 6
#define forward FORWARD
#define backward BACKWARD
#define stop STOP
#define loose LOOSE
#define left LEFT
#define right RIGHT
#define M1 1
#define M2 2
//----------------------------------------------------------------------------//
// TVRemocon
//----------------------------------------------------------------------------//
#define KEY_U 1
#define KEY_D 2
#define KEY_L 3
#define KEY_R 4
#define KEY_C 5
#define KEY_F1 6
#define KEY_F2 7
#define KEY_F3 8
#define KEY_F4 9
#define KEY_CH1 10
#define KEY_CH2 11
#define KEY_CH3 12
#define KEY_CH4 13
#define KEY_FL 14
#define KEY_FR 15
#define LeadCodetime 8
#define TimeChecktime 3000
#define EndChecktime 7
#define TimeCheckdatatime 1500
#define findLeadCode 1
#define startReadCode 2
#define customCodeTVremocon 0b1110000011100000
#define CH1 1
#define CH2 2
#define CH3 3
#define CH4 4
#define CH1_KEY_U 0x80
#define CH1_KEY_D 0x40
#define CH1_KEY_L 0x20
#define CH1_KEY_R 0x10
#define CH1_KEY_C 0xF0
#define CH1_KEY_F1 0x08
#define CH1_KEY_F2 0x88
#define CH1_KEY_F3 0x48
#define CH1_KEY_F4 0xC8
#define CH1_KEY_CH1 0x14
#define CH1_KEY_CH2 0x15
#define CH1_KEY_CH3 0x16
#define CH1_KEY_CH4 0x17
#define CH2_KEY_U 0x8D
#define CH2_KEY_D 0x4D
#define CH2_KEY_L 0x2D
#define CH2_KEY_R 0x1D
#define CH2_KEY_C 0xFD
#define CH2_KEY_F1 0x04
#define CH2_KEY_F2 0x84
#define CH2_KEY_F3 0x44
#define CH2_KEY_F4 0xC4
#define CH2_KEY_CH1 0xE4
#define CH2_KEY_CH2 0xE5
#define CH2_KEY_CH3 0xE6
#define CH2_KEY_CH4 0xE7
#define CH3_KEY_U 0x83
#define CH3_KEY_D 0x43
#define CH3_KEY_L 0x23
#define CH3_KEY_R 0x13
#define CH3_KEY_C 0xF3
#define CH3_KEY_F1 0x0C
#define CH3_KEY_F2 0x8C
#define CH3_KEY_F3 0x4C
#define CH3_KEY_F4 0xCC
#define CH3_KEY_CH1 0x64
#define CH3_KEY_CH2 0x65
#define CH3_KEY_CH3 0x66
#define CH3_KEY_CH4 0x67
#define CH4_KEY_U 0x8B
#define CH4_KEY_D 0x4B
#define CH4_KEY_L 0x2B
#define CH4_KEY_R 0x1B
#define CH4_KEY_C 0xFB
#define CH4_KEY_F1 0x02
#define CH4_KEY_F2 0x82
#define CH4_KEY_F3 0x42
#define CH4_KEY_F4 0xC2
#define CH4_KEY_CH1 0xA4
#define CH4_KEY_CH2 0xA5
#define CH4_KEY_CH3 0xA6
#define CH4_KEY_CH4 0xA7
#define Rf_KEY_UP 0x00
#define Rf_KEY_U 0x01
#define Rf_KEY_D 0x02
#define Rf_KEY_L 0x04
#define Rf_KEY_R 0x08
#define Rf_KEY_1 0x10
#define Rf_KEY_2 0x20
#define Rf_KEY_3 0x40
#define Rf_KEY_4 0x80
#define Rf_KEY_5 0x100
#define Rf_KEY_6 0x200
//----------------------------------------------------------------------------//
// Public Constants
//----------------------------------------------------------------------------//
#define NOTE_B0 31
#define NOTE_C1 33
#define NOTE_CS1 35
#define NOTE_D1 37
#define NOTE_DS1 39
#define NOTE_E1 41
#define NOTE_F1 44
#define NOTE_FS1 46
#define NOTE_G1 49
#define NOTE_GS1 52
#define NOTE_A1 55
#define NOTE_AS1 58
#define NOTE_B1 62
#define NOTE_C2 65
#define NOTE_CS2 69
#define NOTE_D2 73
#define NOTE_DS2 78
#define NOTE_E2 82
#define NOTE_F2 87
#define NOTE_FS2 93
#define NOTE_G2 98
#define NOTE_GS2 104
#define NOTE_A2 110
#define NOTE_AS2 117
#define NOTE_B2 123
#define NOTE_C3 131
#define NOTE_CS3 139
#define NOTE_D3 147
#define NOTE_DS3 156
#define NOTE_E3 165
#define NOTE_F3 175
#define NOTE_FS3 185
#define NOTE_G3 196
#define NOTE_GS3 208
#define NOTE_A3 220
#define NOTE_AS3 233
#define NOTE_B3 247
#define NOTE_C4 262
#define NOTE_CS4 277
#define NOTE_D4 294
#define NOTE_DS4 311
#define NOTE_E4 330
#define NOTE_F4 349
#define NOTE_FS4 370
#define NOTE_G4 392
#define NOTE_GS4 415
#define NOTE_A4 440
#define NOTE_AS4 466
#define NOTE_B4 494
#define NOTE_C5 523
#define NOTE_CS5 554
#define NOTE_D5 587
#define NOTE_DS5 622
#define NOTE_E5 659
#define NOTE_F5 698
#define NOTE_FS5 740
#define NOTE_G5 784
#define NOTE_GS5 831
#define NOTE_A5 880
#define NOTE_AS5 932
#define NOTE_B5 988
#define NOTE_C6 1047
#define NOTE_CS6 1109
#define NOTE_D6 1175
#define NOTE_DS6 1245
#define NOTE_E6 1319
#define NOTE_F6 1397
#define NOTE_FS6 1480
#define NOTE_G6 1568
#define NOTE_GS6 1661
#define NOTE_A6 1760
#define NOTE_AS6 1865
#define NOTE_B6 1976
#define NOTE_C7 2093
#define NOTE_CS7 2217
#define NOTE_D7 2349
#define NOTE_DS7 2489
#define NOTE_E7 2637
#define NOTE_F7 2794
#define NOTE_FS7 2960
#define NOTE_G7 3136
#define NOTE_GS7 3322
#define NOTE_A7 3520
#define NOTE_AS7 3729
#define NOTE_B7 3951
#define NOTE_C8 4186
#define NOTE_CS8 4435
#define NOTE_D8 4699
#define NOTE_DS8 4978
//---------------------------------------------------------------------------------------------------//
void initialize();
int ModeSelect();
void LED_Init();
void LEDControl();
void LEDColorAll(int red, int green, int blue);
void LEDColorR(int value);
void LEDColorG(int value);
void LEDColorB(int value);
void Timer1Set();
void Sound_FireBall();
void Sound_Coin();
void Sound_1up();
void SoundProcess(int _melody[], int _tempo[], int _size);
void Sound_Beep1();
void Sound_Beep2();
void DCControl();
void DCInit();
void DCMotor(char SelectMotor, char direction, char speed);
void DCMove(byte direction, byte speed);
void DCOffsetInput(char SelectMotor, int value);
int DCSpeedLoad();
void PrintSensor();
int ReadMic();
float ReadVoltage();
int RFreceive();
void TVRemocon();
int TVRemoconData();
void CheckLeadCode();
void CheckCustomCode();
void CheckDataCode();
boolean TimeCheckCode(word interval); //micros seconds
boolean TimeCheckLeadcode(word interval); //milliseconds
boolean TimeCheckEnd(word interval); //milliseconds
boolean TimeOutCheckEnd(word interval); //milliseconds
void RemoconChannelSet(byte channel);
void RemoconChannelChange(int _code);
int RemoconCheckCode(int _code);
void TestMode();
void LowBatCheck();
void LedDisplay(int count, int time);
#endif