Line 4... |
Line 4... |
4 |
// BAUD RATE = 9600 |
4 |
// BAUD RATE = 9600 |
5 |
// ========================== PRIPRAVA DAT A VYSTUPU =========================== |
5 |
// ========================== PRIPRAVA DAT A VYSTUPU =========================== |
6 |
// pomocne konstanty |
6 |
// pomocne konstanty |
7 |
#define LEFT 0 |
7 |
#define LEFT 0 |
8 |
#define RIGHT 1 |
8 |
#define RIGHT 1 |
9 |
#define DET_EN 0 // povoluje nebo zakazuje vyhodnoceni SHARP |
9 |
#define DET_EN 1 // povoluje nebo zakazuje vyhodnoceni SHARP |
10 |
|
10 |
|
11 |
// regulator |
11 |
// regulator |
12 |
#define CONP 2 // konstanta pro proporcionalni regulator (2) |
12 |
#define CONP 2 // konstanta pro proporcionalni regulator (2) |
13 |
#define CONI 45 // konstanta pro integracni regulator *0,01 (45) |
13 |
#define CONI 45 // konstanta pro integracni regulator *0,01 (45) |
14 |
#define COND 20 // konstanta pro derivacni regulator *0,01 (20) |
14 |
#define COND 20 // konstanta pro derivacni regulator *0,01 (20) |
Line 88... |
Line 88... |
88 |
int8 line_r; // uklada hodnotu praveho senzoru |
88 |
int8 line_r; // uklada hodnotu praveho senzoru |
89 |
|
89 |
|
90 |
// ================================ DALKOMER =================================== |
90 |
// ================================ DALKOMER =================================== |
91 |
#define SHARP 2 // analogovy kanal pro SHARP |
91 |
#define SHARP 2 // analogovy kanal pro SHARP |
92 |
#define PROBLEM 50 // rozhodovaci uroven, kdy hrozi prekazka |
92 |
#define PROBLEM 50 // rozhodovaci uroven, kdy hrozi prekazka |
93 |
#define BLOCK 90 // rozhodovaci uroven, kdy je jiste prekazka |
93 |
#define BLOCK 70 // rozhodovaci uroven, kdy je jiste prekazka |
94 |
#define DANGER 50 // pocita, jak dlouho je detekovan problem |
94 |
#define DANGER 40 // pocita, jak dlouho je detekovan problem |
95 |
|
95 |
|
96 |
int8 p_count; |
96 |
int8 p_count; |
97 |
int8 sharp_lev; // uklada hodnotu sharp |
97 |
int8 sharp_lev; // uklada hodnotu sharp |
98 |
|
98 |
|
99 |
// ================================== MOTORY =================================== |
99 |
// ================================== MOTORY =================================== |