Line 6... |
Line 6... |
6 |
// pomocne konstanty |
6 |
// pomocne konstanty |
7 |
#define LEFT 0 |
7 |
#define LEFT 0 |
8 |
#define RIGHT 1 |
8 |
#define RIGHT 1 |
9 |
|
9 |
|
10 |
// regulator |
10 |
// regulator |
11 |
#define CONP 10 // konstanta pro proporcionalni regulator |
11 |
#define CONP 12 // konstanta pro proporcionalni regulator |
12 |
#define CONI 2 // konstanta pro integracni regulator |
12 |
#define CONI 2 // konstanta pro integracni regulator |
13 |
#define COND 2 // konstanta pro derivacni regulator |
13 |
#define COND 1 // konstanta pro derivacni regulator |
14 |
|
14 |
|
15 |
int8 reg_out; |
15 |
int8 reg_out; |
16 |
int8 err1; // odchylka prvni hodnoty |
16 |
int8 err1; // odchylka prvni hodnoty |
17 |
int8 err2; |
17 |
int8 err2; |
18 |
int8 err3; |
18 |
int8 err3; |