Tue, 13 Dec 2011 18:41:13 +0100
Added tag STABLE1 for changeset d9126a55295c
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
1 | #include <avr/interrupt.h> |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
2 | #include <avr/io.h> |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
3 | #include <avr/wdt.h> |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
4 | #include <avr/eeprom.h> |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
5 | #include <stdlib.h> |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
6 | #include <stdint.h> |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
7 | #include <avr/pgmspace.h> |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
8 | #include <util/delay.h> |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
9 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
10 | #include "driver/rs232.h" |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
11 | #include "driver/adc.h" |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
12 | |
2
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
13 | #include "main.h" |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
14 | #include "lowlevel.h" |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
15 | |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
16 | char ok[] PROGMEM="OK\n"; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
17 | char busy[] PROGMEM="BUSY\n"; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
18 | char prepare[] PROGMEM="!RACE PREPARE\n"; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
19 | char countdownstart[] PROGMEM="!COUNTDOWN\n"; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
20 | char racestart[] PROGMEM="!RACE START\n"; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
21 | |
45 | 22 | typedef union { |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
23 | uint32_t value; |
45 | 24 | uint16_t word[2]; // high, low word |
25 | uint8_t byte[4]; // all four bytes | |
26 | } u32; | |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
27 | |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
28 | #define FUEL_FULL 10000 |
75
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
29 | #define FUEL_DIV_DEFAULT 25 |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
30 | volatile uint8_t fuel_divisor = FUEL_DIV_DEFAULT; // default, can be set via serial command |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
31 | |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
32 | typedef struct { |
49
3957ff8e86c6
more memsave through packed structure#
Malte Bayer <mbayer@neo-soft.org>
parents:
48
diff
changeset
|
33 | unsigned speedlimit:4; // 4bits speedlimit |
3957ff8e86c6
more memsave through packed structure#
Malte Bayer <mbayer@neo-soft.org>
parents:
48
diff
changeset
|
34 | unsigned speedminimum:4; // 4bits speedminimum |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
35 | unsigned seccnt:4; // 4 bits tenth seconds counter |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
36 | unsigned accel:4; // 4 bits last configured acceleration |
49
3957ff8e86c6
more memsave through packed structure#
Malte Bayer <mbayer@neo-soft.org>
parents:
48
diff
changeset
|
37 | unsigned trackswitch:1; // 1bit bool |
60
bfc2f2d6913c
added refueling mechanism by stopping the car
Malte Bayer <mbayer@neo-soft.org>
parents:
59
diff
changeset
|
38 | unsigned canrefuel:1; // 1bit bool |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
39 | uint16_t jumpstart_time, laps, fuel; |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
40 | u32 lap_time_start, lap_time; |
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
41 | } cardata; |
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
42 | |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
43 | static char s[8]; |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
44 | static uint8_t countdown, countdown_loops; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
45 | uint8_t mode = 0; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
46 | // valid race modes: |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
47 | // 0: free drive / idle |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
48 | // 1: waiting for countdown start |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
49 | // 2: race countdown initiated |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
50 | // 3: Race start condition |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
51 | uint8_t liveinfo = 0; |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
52 | uint8_t fuel_enabled = 1; |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
53 | |
45 | 54 | volatile u32 sysclk; |
42
018d4d63ad3b
implemented 500ns timer and set jumpstart time
Malte Bayer <mbayer@neo-soft.org>
parents:
41
diff
changeset
|
55 | volatile uint8_t sysclk_packettimer = 0; |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
56 | volatile cardata slot[MAX_SLOTS]; |
44
4f4326794ba4
implemented lap time, there is some bug in 32bit substraction yet
Malte Bayer <mbayer@neo-soft.org>
parents:
43
diff
changeset
|
57 | |
48
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
58 | volatile uint8_t car0, car1; |
41
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
59 | volatile uint16_t car0_new, car0_old; |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
60 | volatile uint16_t car1_new, car1_old; |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
61 | uint8_t car0_state, car1_state; |
36
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
62 | |
4
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
63 | volatile uint8_t program_count = 0; |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
64 | volatile uint8_t program_id; |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
65 | volatile uint8_t program_command; |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
66 | volatile uint8_t program_parameter; |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
67 | |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
68 | volatile uint8_t datalen = 0; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
69 | char data[10]; // 8 bytes data buffer + string termination |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
70 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
71 | static char buffer[RS232_BUFSIZE+1]; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
72 | static uint8_t buffer_len; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
73 | |
6
2405aff29a51
added response receiver timer
Malte Bayer <mbayer@neo-soft.org>
parents:
5
diff
changeset
|
74 | volatile uint16_t transmit_buffer; |
2405aff29a51
added response receiver timer
Malte Bayer <mbayer@neo-soft.org>
parents:
5
diff
changeset
|
75 | volatile uint16_t transmit_buffer_queue; |
2405aff29a51
added response receiver timer
Malte Bayer <mbayer@neo-soft.org>
parents:
5
diff
changeset
|
76 | volatile uint8_t transmit_len; |
2405aff29a51
added response receiver timer
Malte Bayer <mbayer@neo-soft.org>
parents:
5
diff
changeset
|
77 | volatile uint8_t transmit_len_next; |
2405aff29a51
added response receiver timer
Malte Bayer <mbayer@neo-soft.org>
parents:
5
diff
changeset
|
78 | volatile uint8_t transmit_len_queue; |
2405aff29a51
added response receiver timer
Malte Bayer <mbayer@neo-soft.org>
parents:
5
diff
changeset
|
79 | |
69
27c0c0095e26
implemented responsewire in CU firmware
Malte Bayer <mbayer@neo-soft.org>
parents:
64
diff
changeset
|
80 | volatile uint16_t responsewire_data = 0; |
6
2405aff29a51
added response receiver timer
Malte Bayer <mbayer@neo-soft.org>
parents:
5
diff
changeset
|
81 | volatile uint16_t response; |
33 | 82 | volatile uint8_t response_len; |
6
2405aff29a51
added response receiver timer
Malte Bayer <mbayer@neo-soft.org>
parents:
5
diff
changeset
|
83 | volatile uint8_t timer0_delay; |
2405aff29a51
added response receiver timer
Malte Bayer <mbayer@neo-soft.org>
parents:
5
diff
changeset
|
84 | |
2405aff29a51
added response receiver timer
Malte Bayer <mbayer@neo-soft.org>
parents:
5
diff
changeset
|
85 | |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
86 | /* RESPONSEWIRE frame format: |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
87 | 1 startbit |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
88 | 2 car id bit 1 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
89 | 3 car id bit 2 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
90 | 4 car id bit 3 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
91 | 5 track change status bit 1 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
92 | 6 track change status bit 2 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
93 | 7 track change status bit 3 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
94 | 8 track change status bit 4 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
95 | 9 sender id bit 1 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
96 | 10 sender id bit 2 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
97 | 11 sender id bit 3 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
98 | 12 sender id bit 4 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
99 | 13 device type bit 1 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
100 | 14 device type bit 2 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
101 | 15 device type bit 3 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
102 | 16 stopbit |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
103 | */ |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
104 | |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
105 | /* PITLANE/TRACKSWITCH STATUS DEFINITION |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
106 | 1 = AA |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
107 | 2 = AB |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
108 | 3 = BB |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
109 | 4 = BA |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
110 | 5 = BC |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
111 | 6 = ZZ -> pitlane exit |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
112 | */ |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
113 | |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
114 | #define STARTSTOP 0b1000000000000001 |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
115 | void decode_responsewire(void) { |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
116 | // ATTENTION: THIS IS CALLED IN AN INTERRUPT, KEEP AS SHORT AS POSSIBLE |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
117 | |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
118 | uint16_t data = responsewire_data; |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
119 | // first check if start + stopbit are set |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
120 | // todo future: unsure but last bit doesnt get set?! |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
121 | /* |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
122 | if ((data & STARTSTOP) != STARTSTOP) { |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
123 | RS232_puts("RW BAD\n"); |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
124 | return; // incomplete response |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
125 | } |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
126 | */ |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
127 | // now extract the car id, track change status |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
128 | data >>= 1; |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
129 | uint8_t car = (data & 0b111); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
130 | data >>= 3; |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
131 | uint8_t status = (data & 0b1111); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
132 | data >>= 4; |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
133 | uint8_t sender = (data & 0b1111); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
134 | data >>= 4; |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
135 | uint8_t type = (data & 0b111); |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
136 | if (type == 4) { |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
137 | // pitlane response |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
138 | if (status == 5) slot[car].canrefuel = 1; |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
139 | if (status == 6) for (data=0; data<MAX_SLOTS; data++) slot[data].canrefuel = 0; |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
140 | } |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
141 | RS232_puts("RW:"); |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
142 | RS232_putc(car + '0'); |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
143 | RS232_putc(':'); |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
144 | RS232_putc(type + '0'); |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
145 | RS232_putc(':'); |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
146 | itoa(sender, s, 16); |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
147 | RS232_puts(s); |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
148 | RS232_putc(':'); |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
149 | itoa(status, s, 16); |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
150 | RS232_puts(s); |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
151 | RS232_putc(':'); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
152 | ultoa(sysclk.value, s, 16); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
153 | RS232_puts(s); |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
154 | RS232_putc('\n'); |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
155 | } |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
156 | |
35
00166228a419
cli: implemented setting of fuel, brake, speed, blinkstate for any car
Malte Bayer <mbayer@neo-soft.org>
parents:
34
diff
changeset
|
157 | int insert_queue(uint16_t tmp, uint8_t len) { |
00166228a419
cli: implemented setting of fuel, brake, speed, blinkstate for any car
Malte Bayer <mbayer@neo-soft.org>
parents:
34
diff
changeset
|
158 | if (transmit_buffer_queue == 0) { |
00166228a419
cli: implemented setting of fuel, brake, speed, blinkstate for any car
Malte Bayer <mbayer@neo-soft.org>
parents:
34
diff
changeset
|
159 | transmit_buffer_queue = tmp; |
00166228a419
cli: implemented setting of fuel, brake, speed, blinkstate for any car
Malte Bayer <mbayer@neo-soft.org>
parents:
34
diff
changeset
|
160 | transmit_len_queue = len; |
00166228a419
cli: implemented setting of fuel, brake, speed, blinkstate for any car
Malte Bayer <mbayer@neo-soft.org>
parents:
34
diff
changeset
|
161 | return 1; |
00166228a419
cli: implemented setting of fuel, brake, speed, blinkstate for any car
Malte Bayer <mbayer@neo-soft.org>
parents:
34
diff
changeset
|
162 | } |
00166228a419
cli: implemented setting of fuel, brake, speed, blinkstate for any car
Malte Bayer <mbayer@neo-soft.org>
parents:
34
diff
changeset
|
163 | return 0; |
00166228a419
cli: implemented setting of fuel, brake, speed, blinkstate for any car
Malte Bayer <mbayer@neo-soft.org>
parents:
34
diff
changeset
|
164 | } |
00166228a419
cli: implemented setting of fuel, brake, speed, blinkstate for any car
Malte Bayer <mbayer@neo-soft.org>
parents:
34
diff
changeset
|
165 | |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
166 | ISR ( USART_RXC_vect ) { |
36
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
167 | uint8_t tmp; |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
168 | char c = UDR; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
169 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
170 | // check for buffer overflow |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
171 | if (buffer_len==sizeof(buffer)) { |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
172 | buffer_len=0; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
173 | } else { |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
174 | // collect characters until end of line |
35
00166228a419
cli: implemented setting of fuel, brake, speed, blinkstate for any car
Malte Bayer <mbayer@neo-soft.org>
parents:
34
diff
changeset
|
175 | if ( (c=='\n') ) { |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
176 | buffer[buffer_len]=0; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
177 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
178 | // packet end received, parse the received packet |
4
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
179 | switch (buffer[0]) { |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
180 | case 'P': // inject a program data word to the rails |
5
7319de27d44a
added queue busy response on command injection
Malte Bayer <mbayer@neo-soft.org>
parents:
4
diff
changeset
|
181 | if (program_count == 0) { |
7319de27d44a
added queue busy response on command injection
Malte Bayer <mbayer@neo-soft.org>
parents:
4
diff
changeset
|
182 | program_id = buffer[3]-'0'; |
7319de27d44a
added queue busy response on command injection
Malte Bayer <mbayer@neo-soft.org>
parents:
4
diff
changeset
|
183 | program_command = buffer[1]-'0'; |
10 | 184 | if (program_command > 9) |
185 | program_command = buffer[1]-'A'+10; | |
5
7319de27d44a
added queue busy response on command injection
Malte Bayer <mbayer@neo-soft.org>
parents:
4
diff
changeset
|
186 | program_parameter = buffer[2]-'0'; |
10 | 187 | if (program_parameter > 9) |
188 | program_parameter = buffer[2]-'A'+10; | |
5
7319de27d44a
added queue busy response on command injection
Malte Bayer <mbayer@neo-soft.org>
parents:
4
diff
changeset
|
189 | if (program_command < 4) |
7319de27d44a
added queue busy response on command injection
Malte Bayer <mbayer@neo-soft.org>
parents:
4
diff
changeset
|
190 | program_count = 0x02; // send commands twice (fuel, speed, brake) |
7319de27d44a
added queue busy response on command injection
Malte Bayer <mbayer@neo-soft.org>
parents:
4
diff
changeset
|
191 | else |
7319de27d44a
added queue busy response on command injection
Malte Bayer <mbayer@neo-soft.org>
parents:
4
diff
changeset
|
192 | program_count = 0x01; |
36
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
193 | RS232_puts_p(ok); |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
194 | } else RS232_puts_p(busy); |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
195 | break; |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
196 | |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
197 | case 'L': // Limit maximum speed for a car |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
198 | tmp = buffer[2]-'0'; |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
199 | if (tmp > 9) |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
200 | tmp = buffer[2]-'A'+10; |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
201 | slot[buffer[1]-'0'].speedlimit = tmp; |
36
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
202 | RS232_puts_p(ok); |
5
7319de27d44a
added queue busy response on command injection
Malte Bayer <mbayer@neo-soft.org>
parents:
4
diff
changeset
|
203 | break; |
4
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
204 | |
48
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
205 | case 'S': // set minimum speed for a car |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
206 | tmp = buffer[2]-'0'; |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
207 | if (tmp > 9) |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
208 | tmp = buffer[2]-'A'+10; |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
209 | slot[buffer[1]-'0'].speedminimum = tmp; |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
210 | RS232_puts_p(ok); |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
211 | break; |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
212 | |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
213 | case 'F': // set fuel enabled |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
214 | fuel_enabled = buffer[1]-'0'; |
75
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
215 | if (buffer[2] == ':') { |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
216 | // convert fuel divisor |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
217 | buffer[0] = '0'; // atoi expects zeros! |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
218 | buffer[1] = '0'; |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
219 | buffer[2] = '0'; |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
220 | RS232_puts("DivisorChange: "); |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
221 | itoa(fuel_divisor, s, 10); |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
222 | RS232_puts(s); |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
223 | RS232_putc('>'); |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
224 | fuel_divisor = atoi(buffer); |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
225 | itoa(fuel_divisor, s, 10); |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
226 | RS232_puts(s); |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
227 | RS232_putc(' '); |
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
228 | } |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
229 | RS232_puts_p(ok); |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
230 | break; |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
231 | |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
232 | case '*': // set live information |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
233 | liveinfo = buffer[1]-'0'; |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
234 | RS232_puts_p(ok); |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
235 | break; |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
236 | |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
237 | |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
238 | case 'I': // get Information data (incl. important global parameter dump) |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
239 | RS232_puts(VERSION); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
240 | RS232_putc(':'); |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
241 | for (tmp=0;tmp<MAX_SLOTS;tmp++) RS232_putc(slot[tmp].speedlimit); // output speed limits |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
242 | RS232_putc(':'); |
48
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
243 | for (tmp=0;tmp<MAX_SLOTS;tmp++) RS232_putc(slot[tmp].speedminimum); // output minimum speed |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
244 | RS232_putc(':'); |
43
4e5d389f7b83
jumpstart time output via interface
Malte Bayer <mbayer@neo-soft.org>
parents:
42
diff
changeset
|
245 | for (tmp=0;tmp<MAX_SLOTS;tmp++) { |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
246 | itoa(slot[tmp].fuel, s, 16); |
43
4e5d389f7b83
jumpstart time output via interface
Malte Bayer <mbayer@neo-soft.org>
parents:
42
diff
changeset
|
247 | RS232_putc(s); // output fuel levels (0=empty, 100=full, 0xff=no fuel option) |
4e5d389f7b83
jumpstart time output via interface
Malte Bayer <mbayer@neo-soft.org>
parents:
42
diff
changeset
|
248 | RS232_putc(','); |
4e5d389f7b83
jumpstart time output via interface
Malte Bayer <mbayer@neo-soft.org>
parents:
42
diff
changeset
|
249 | } |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
250 | RS232_putc(':'); |
43
4e5d389f7b83
jumpstart time output via interface
Malte Bayer <mbayer@neo-soft.org>
parents:
42
diff
changeset
|
251 | for (tmp=0;tmp<MAX_SLOTS;tmp++) { |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
252 | itoa(slot[tmp].jumpstart_time, s, 16); |
43
4e5d389f7b83
jumpstart time output via interface
Malte Bayer <mbayer@neo-soft.org>
parents:
42
diff
changeset
|
253 | RS232_puts(s); // output jumpstart times |
4e5d389f7b83
jumpstart time output via interface
Malte Bayer <mbayer@neo-soft.org>
parents:
42
diff
changeset
|
254 | RS232_putc(','); |
4e5d389f7b83
jumpstart time output via interface
Malte Bayer <mbayer@neo-soft.org>
parents:
42
diff
changeset
|
255 | } |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
256 | RS232_putc(':'); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
257 | RS232_putc('\n'); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
258 | break; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
259 | |
4
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
260 | } |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
261 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
262 | // wait for the next packet |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
263 | buffer_len=0; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
264 | } else { |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
265 | buffer[buffer_len++]=c; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
266 | } |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
267 | } |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
268 | } |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
269 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
270 | |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
271 | void jumpstart(uint8_t controller) { |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
272 | if (slot[controller].jumpstart_time == 0) { |
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
273 | slot[controller].jumpstart_time = sysclk.word[0]; // low word |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
274 | RS232_putc('~'); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
275 | RS232_putc('0'-controller); |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
276 | RS232_putc(':'); |
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
277 | itoa(slot[controller].jumpstart_time, s, 16); |
43
4e5d389f7b83
jumpstart time output via interface
Malte Bayer <mbayer@neo-soft.org>
parents:
42
diff
changeset
|
278 | RS232_puts(s); |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
279 | RS232_putc('\n'); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
280 | } |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
281 | |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
282 | } |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
283 | |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
284 | uint8_t do_controller(uint8_t controller) { |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
285 | // read controller X speed & encode controller data packet |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
286 | uint16_t tmp = 0; |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
287 | uint8_t speed; |
51
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
288 | uint8_t trackchange = 0xff; |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
289 | |
48
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
290 | if ( (PIN(SW_PACECAR_PORT) & _BV(SW_PACECAR)) == 0 ) { |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
291 | // map controller 1+2 to 5+6 |
51
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
292 | if (controller == 4) tmp = ((getADC(CONTROLLER1_SPEED) / CONTROLLER_DIVISOR) & 0x0F); |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
293 | if (controller == 5) tmp = ((getADC(CONTROLLER2_SPEED) / CONTROLLER_DIVISOR) & 0x0F); |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
294 | if (controller == 4) trackchange = (PIN(CONTROLLER_PORT) & _BV(CONTROLLER1_SW)); |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
295 | if (controller == 5) trackchange = (PIN(CONTROLLER_PORT) & _BV(CONTROLLER2_SW)); |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
296 | speed = tmp; |
51
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
297 | } else { |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
298 | // read speeds |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
299 | if ((controller == 0) && (mode!=1)) tmp = ((getADC(CONTROLLER1_SPEED) / CONTROLLER_DIVISOR) & 0x0F); |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
300 | if ((controller == 1) && (mode!=1)) tmp = ((getADC(CONTROLLER2_SPEED) / CONTROLLER_DIVISOR) & 0x0F); |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
301 | if ((controller == 2) && (mode!=1)) tmp = ((getADC(CONTROLLER3_SPEED) / CONTROLLER_DIVISOR) & 0x0F); |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
302 | if ((controller == 3) && (mode!=1)) tmp = ((getADC(CONTROLLER4_SPEED) / CONTROLLER_DIVISOR) & 0x0F); |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
303 | if (controller == 0) trackchange = (PIN(CONTROLLER_PORT) & _BV(CONTROLLER1_SW)); |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
304 | if (controller == 1) trackchange = (PIN(CONTROLLER_PORT) & _BV(CONTROLLER2_SW)); |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
305 | if (controller == 2) trackchange = (PIN(CONTROLLER_PORT) & _BV(CONTROLLER3_SW)); |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
306 | if (controller == 3) trackchange = (PIN(CONTROLLER_PORT) & _BV(CONTROLLER4_SW)); |
52
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
307 | |
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
308 | if (controller < 4) { |
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
309 | if (tmp < slot[controller].speedminimum) tmp = slot[controller].speedminimum; |
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
310 | if ((mode == 2) && (tmp != 0)) { jumpstart(controller); tmp = 0; } |
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
311 | if (tmp > slot[controller].speedlimit) tmp = slot[controller].speedlimit; |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
312 | speed = tmp; |
52
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
313 | tmp = tmp << 1; |
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
314 | } else { |
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
315 | if ((mode == 0) && (tmp < slot[controller].speedminimum)) tmp = slot[controller].speedminimum; |
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
316 | if (tmp > slot[controller].speedlimit) tmp = slot[controller].speedlimit; |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
317 | speed = tmp; |
52
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
318 | tmp = tmp << 1; |
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
319 | if (trackchange || slot[controller].trackswitch) tmp |= (1<<5); |
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
320 | } |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
321 | |
48
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
322 | } |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
323 | |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
324 | switch (controller) { |
3 | 325 | case 0: |
51
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
326 | if (trackchange != 0) { |
10 | 327 | tmp |= (1<<5); |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
328 | if (mode == 0) LED(1,0); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
329 | } else if (mode == 0) LED(1,1); |
3 | 330 | break; |
331 | case 1: | |
51
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
332 | if (trackchange != 0) { |
10 | 333 | tmp |= (1<<5); |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
334 | if (mode == 0) LED(2,0); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
335 | } else if (mode == 0) LED(2,1); |
3 | 336 | break; |
337 | case 2: | |
51
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
338 | if (trackchange != 0) { |
10 | 339 | tmp |= (1<<5); |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
340 | if (mode == 0) LED(4,0); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
341 | } else if (mode == 0) LED(4,1); |
3 | 342 | break; |
343 | case 3: | |
51
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
344 | if (trackchange != 0) { |
10 | 345 | tmp |= (1<<5); |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
346 | if (mode == 0) LED(5,0); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
347 | } else if (mode == 0) LED(5,1); |
3 | 348 | break; |
52
6b26d7e3ecd0
simplified do_controller function
Malte Bayer <mbayer@neo-soft.org>
parents:
51
diff
changeset
|
349 | } |
48
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
350 | |
34 | 351 | tmp |= (0b1000000000 | (controller << 6)); |
60
bfc2f2d6913c
added refueling mechanism by stopping the car
Malte Bayer <mbayer@neo-soft.org>
parents:
59
diff
changeset
|
352 | // FUEL BIT GETS SET WHEN FUEL == 0, |
bfc2f2d6913c
added refueling mechanism by stopping the car
Malte Bayer <mbayer@neo-soft.org>
parents:
59
diff
changeset
|
353 | // THIS REQUIRES PHYSICAL CAR FUEL LEVEL SET TO ZERO BEFORE! |
bfc2f2d6913c
added refueling mechanism by stopping the car
Malte Bayer <mbayer@neo-soft.org>
parents:
59
diff
changeset
|
354 | if ( ((PIN(SW_FUEL_PORT) & _BV(SW_FUEL)) != 0) | (slot[controller].fuel == 0)) tmp |= 1; // benzinstand aktiv - tankmodusschalter |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
355 | if (insert_queue(tmp, 9)) { |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
356 | if (fuel_enabled) { |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
357 | if (speed != 0) { |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
358 | // do the fuel calculation, regardless if fuel logic active or not |
75
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
359 | tmp = (uint8_t)(((slot[controller].accel * speed) + 1) / fuel_divisor); |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
360 | if (tmp == 0) tmp = 1; |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
361 | if (slot[controller].fuel > 0) { |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
362 | // enough fuel left to decrement? |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
363 | if (slot[controller].fuel > tmp) { |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
364 | slot[controller].fuel -= tmp; // decrement fuel level |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
365 | } else slot[controller].fuel = 0; |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
366 | } |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
367 | } else if (slot[controller].canrefuel) { |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
368 | // increase fuel by 5%/sec, this equals by adding 50 to the counter |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
369 | slot[controller].fuel += 50; |
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
370 | if (slot[controller].fuel > FUEL_FULL) slot[controller].fuel = FUEL_FULL; |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
371 | } |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
372 | return 1; |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
373 | } |
75
0b38de31ad5d
made fuel divisor configurable
Malte Bayer <mbayer@neo-soft.org>
parents:
73
diff
changeset
|
374 | return 1; |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
375 | } else return 0; |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
376 | } |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
377 | |
4
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
378 | uint8_t mirror( uint8_t n ) { |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
379 | n = ((n >> 1) & 0x55) | ((n << 1) & 0xaa); |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
380 | n = ((n >> 2) & 0x33) | ((n << 2) & 0xcc); |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
381 | n = ((n >> 4) & 0x0f) | ((n << 4) & 0xf0); |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
382 | return n; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
383 | } |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
384 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
385 | int do_program(uint8_t controller, uint8_t command, uint8_t parameter) { |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
386 | // send program data packet |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
387 | uint16_t tmp; |
4
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
388 | parameter = mirror(parameter); |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
389 | controller = mirror(controller); |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
390 | command = mirror(command); |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
391 | tmp = 0b1000000000000 | (parameter << 4) | command | (controller >> 5); |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
392 | return insert_queue(tmp, 12); |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
393 | } |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
394 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
395 | int do_active(void) { |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
396 | // send controller active data packet |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
397 | uint16_t tmp = 0b10000000; |
51
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
398 | if ( (PIN(SW_PACECAR_PORT) & _BV(SW_PACECAR)) == 0 ) { |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
399 | // map controller 1+2 to 5+6 |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
400 | if ((getADC(CONTROLLER1_SPEED) / CONTROLLER_DIVISOR) > 0) tmp |= 0b10000101; |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
401 | if ((getADC(CONTROLLER2_SPEED) / CONTROLLER_DIVISOR) > 0) tmp |= 0b10000011; |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
402 | } else { |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
403 | if ((slot[0].speedminimum != 0) || ((getADC(CONTROLLER1_SPEED) / CONTROLLER_DIVISOR) > 0)) tmp |= 0b11000001; |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
404 | if ((slot[1].speedminimum != 0) || ((getADC(CONTROLLER2_SPEED) / CONTROLLER_DIVISOR) > 0)) tmp |= 0b10100001; |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
405 | if ((slot[2].speedminimum != 0) || ((getADC(CONTROLLER3_SPEED) / CONTROLLER_DIVISOR) > 0)) tmp |= 0b10010001; |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
406 | if ((slot[3].speedminimum != 0) || ((getADC(CONTROLLER4_SPEED) / CONTROLLER_DIVISOR) > 0)) tmp |= 0b10001001; |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
407 | if (slot[4].speedminimum != 0) tmp |= 0b10000101; |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
408 | if (slot[5].speedminimum != 0) tmp |= 0b10000011; |
ec9e8cc27012
car id setting for slot 5+6 working via pressing pacecar button
Malte Bayer <mbayer@neo-soft.org>
parents:
49
diff
changeset
|
409 | } |
4
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
410 | // todo: wenn Daten enpfangen wurden hier eine Quittierung senden anstatt dem Active Word |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
411 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
412 | return insert_queue(tmp, 7); |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
413 | } |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
414 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
415 | int do_pace_ghost(void) { |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
416 | // send ghost and pacecar data packet |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
417 | // todo: at the moment, both disabled! |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
418 | uint16_t tmp = 0b1111100000; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
419 | if ( (PIN(SW_FUEL_PORT) & _BV(SW_FUEL)) != 0) tmp |= 1; // benzinstand aktiv - tankmodusschalter |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
420 | // todo: PC, NH, TK, (KFR, FR) |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
421 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
422 | return insert_queue(tmp, 9); |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
423 | } |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
424 | |
53
f659e6faf18f
moved ISRs from main.c to interrupts.c
Malte Bayer <mbayer@neo-soft.org>
parents:
52
diff
changeset
|
425 | #include "interrupts.c" |
7
f4e250d5402b
fixes, bound lap counter reset to race start button
Malte Bayer <mbayer@neo-soft.org>
parents:
6
diff
changeset
|
426 | |
36
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
427 | void reset_vars(void) { |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
428 | uint8_t i; |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
429 | for (i=0; i<MAX_SLOTS; i++) { |
48
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
430 | slot[i].speedlimit = 15; |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
431 | slot[i].speedminimum = 0; |
5bba01aad0a6
memsave and implemented minimum slot speed for virtual cars
Malte Bayer <mbayer@neo-soft.org>
parents:
47
diff
changeset
|
432 | slot[i].trackswitch = 0; |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
433 | slot[i].fuel = FUEL_FULL; |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
434 | slot[i].jumpstart_time = 0; |
47
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
435 | slot[i].laps = 0; |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
436 | slot[i].seccnt = 0; |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
437 | slot[i].accel = 15; // full acceleration per default - TODO |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
438 | slot[i].canrefuel = 0; |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
439 | slot[i].lap_time_start.value = 0; |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
440 | slot[i].lap_time.value = 0; |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
441 | } |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
442 | sysclk.value = 0; |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
443 | } |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
444 | |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
445 | void countdown_progress(void) { |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
446 | // decrement COUNTDOWN_LOOPS |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
447 | if (countdown_loops>0) { |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
448 | countdown_loops--; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
449 | } else { |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
450 | countdown--; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
451 | countdown_loops = COUNTDOWN_DELAY; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
452 | } |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
453 | switch (countdown) { |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
454 | case 5: LED(1, 1); break; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
455 | case 4: LED(2, 1); break; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
456 | case 3: LED(3, 1); break; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
457 | case 2: LED(4, 1); break; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
458 | case 1: LED(5, 1); break; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
459 | case 0: { // RACE START! |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
460 | sysclk.value = 0; |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
461 | LEDS_OFF(); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
462 | LED(3, 1); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
463 | mode = 3; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
464 | } break; |
36
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
465 | } |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
466 | } |
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
467 | |
41
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
468 | void check_cars(void) { |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
469 | u32 clk, diff; |
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
470 | clk.value = sysclk.value; // freeze system clock time |
44
4f4326794ba4
implemented lap time, there is some bug in 32bit substraction yet
Malte Bayer <mbayer@neo-soft.org>
parents:
43
diff
changeset
|
471 | |
41
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
472 | if (car0 != car0_state) { |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
473 | car0_state = car0; |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
474 | if (car0_state != 0) { |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
475 | diff.value = clk.value - slot[car0-1].lap_time_start.value; |
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
476 | if ( diff.value > 3000 ) { // minimum 1.5 second for 1 lap! |
47
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
477 | if (slot[car0-1].lap_time_start.value != 0) { |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
478 | slot[car0-1].lap_time.value = diff.value; |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
479 | slot[car0-1].laps++; |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
480 | RS232_puts("L:3:"); // 3 = BB |
47
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
481 | itoa(slot[car0-1].laps, s, 16); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
482 | RS232_puts(s); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
483 | RS232_putc(':'); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
484 | RS232_putc('0'+car0_state); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
485 | RS232_putc(':'); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
486 | ultoa(diff.value, s, 16); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
487 | RS232_puts(s); |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
488 | RS232_putc(':'); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
489 | ultoa(clk.value, s, 16); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
490 | RS232_puts(s); |
47
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
491 | RS232_putc('\n'); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
492 | } |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
493 | slot[car0-1].lap_time_start.value = clk.value; |
44
4f4326794ba4
implemented lap time, there is some bug in 32bit substraction yet
Malte Bayer <mbayer@neo-soft.org>
parents:
43
diff
changeset
|
494 | } |
41
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
495 | } |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
496 | } car0 = 0; |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
497 | |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
498 | if (car1 != car1_state) { |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
499 | car1_state = car1; |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
500 | if (car1_state != 0) { |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
501 | diff.value = clk.value - slot[car1-1].lap_time_start.value; |
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
502 | if ( diff.value > 3000 ) { // minimum 1.5 second for 1 lap! |
47
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
503 | if (slot[car1-1].lap_time_start.value != 0) { |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
504 | slot[car1-1].lap_time.value = diff.value; |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
505 | slot[car1-1].laps++; |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
506 | RS232_puts("L:1:"); // 1 = AA |
47
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
507 | itoa(slot[car1-1].laps, s, 16); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
508 | RS232_puts(s); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
509 | RS232_putc(':'); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
510 | RS232_putc('0'+car1_state); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
511 | RS232_putc(':'); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
512 | ultoa(diff.value, s, 16); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
513 | RS232_puts(s); |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
514 | RS232_putc(':'); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
515 | ultoa(clk.value, s, 16); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
516 | RS232_puts(s); |
47
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
517 | RS232_putc('\n'); |
34ac9f92bc1e
implemented lap counter, doesnt count first sensor touch
Malte Bayer <mbayer@neo-soft.org>
parents:
46
diff
changeset
|
518 | } |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
519 | slot[car1-1].lap_time_start.value = clk.value; |
44
4f4326794ba4
implemented lap time, there is some bug in 32bit substraction yet
Malte Bayer <mbayer@neo-soft.org>
parents:
43
diff
changeset
|
520 | } |
41
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
521 | } |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
522 | } car1 = 0; |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
523 | } |
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
524 | |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
525 | void slot_liveinfo(uint8_t idx) { |
73
ec888cfa024e
bugfix: responsewire bitmap, todo: trackswitch response
Malte Bayer <mbayer@neo-soft.org>
parents:
69
diff
changeset
|
526 | if (liveinfo == 0) return; |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
527 | // increment packet counter, if == 10 output some live info |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
528 | if (slot[idx].seccnt == 10) { |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
529 | // output current fuel status |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
530 | RS232_putc('F'); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
531 | RS232_putc(':'); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
532 | RS232_putc(idx + '0'); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
533 | RS232_putc(':'); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
534 | itoa(slot[idx].fuel, s, 16); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
535 | RS232_puts(s); |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
536 | RS232_putc(':'); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
537 | ultoa(sysclk.value, s, 16); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
538 | RS232_puts(s); |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
539 | RS232_putc('\n'); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
540 | |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
541 | slot[idx].seccnt = 0; |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
542 | } else slot[idx].seccnt++; |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
543 | } |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
544 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
545 | int main(void) |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
546 | { |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
547 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
548 | uint8_t packet_index = 1; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
549 | |
8 | 550 | uint8_t btn_start = _BV(SW_START); |
551 | uint8_t old_start = btn_start; | |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
552 | |
41
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
553 | |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
554 | init_hardware(); |
36
aea84f4f5a12
feature: program a specific controller speed limit without changing the car's acceleration
Malte Bayer <mbayer@neo-soft.org>
parents:
35
diff
changeset
|
555 | reset_vars(); |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
556 | LED(3, 1); // enable middle led == idle mode |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
557 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
558 | // switch on rails power |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
559 | RAIL_POWER_PORT |= _BV(RAIL_POWER); |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
560 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
561 | while (1) { |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
562 | // check for short circuit on the rails |
2
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
563 | check_rails_shortcut(); |
41
9857c18c5e64
implemented car detection to cu
Malte Bayer <mbayer@neo-soft.org>
parents:
37
diff
changeset
|
564 | check_cars(); |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
565 | |
33 | 566 | if (response_len > 0) { |
567 | itoa(response, s, 2); | |
568 | response_len = 0; | |
77
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
569 | //RS232_puts("ANSWER RX: "); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
570 | //RS232_puts(s); |
cede78304992
finished live CLI, BB firmware improvements and fixes
Malte Bayer <mbayer@neo-soft.org>
parents:
75
diff
changeset
|
571 | //RS232_putc('\n'); |
33 | 572 | } |
573 | ||
574 | ||
7
f4e250d5402b
fixes, bound lap counter reset to race start button
Malte Bayer <mbayer@neo-soft.org>
parents:
6
diff
changeset
|
575 | // read in button presses |
8 | 576 | btn_start = (PIN(SW_START_PORT) & _BV(SW_START)); |
577 | if (old_start != btn_start) { | |
578 | // start button changed | |
579 | if (btn_start == 0) { | |
580 | // start button press active | |
581 | if (mode == 0) { | |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
582 | mode = 1; // set wait for race start mode |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
583 | reset_vars(); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
584 | LED(1, 1); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
585 | LED(2, 1); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
586 | LED(3, 1); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
587 | LED(4, 1); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
588 | LED(5, 1); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
589 | RS232_puts_p(prepare); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
590 | } else if (mode == 1) { |
8 | 591 | // Initiate race countdown |
46
d200e3d8a550
corrected lap times, packed data struct for each slotcar
Malte Bayer <mbayer@neo-soft.org>
parents:
45
diff
changeset
|
592 | sysclk.value = 0; |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
593 | countdown = 5; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
594 | countdown_loops = COUNTDOWN_DELAY; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
595 | mode = 2; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
596 | LED(1, 0); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
597 | LED(2, 0); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
598 | LED(3, 0); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
599 | LED(4, 0); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
600 | LED(5, 0); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
601 | RS232_puts_p(countdownstart); |
8 | 602 | } |
603 | } | |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
604 | old_start = btn_start; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
605 | } |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
606 | |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
607 | if (mode==3) { |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
608 | // RACE START! |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
609 | // issue reset command to lap counter |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
610 | mode = 0; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
611 | RS232_puts_p(racestart); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
612 | program_command = 6; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
613 | program_parameter = 9; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
614 | program_id = 0; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
615 | program_count = 1; |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
616 | LAP_COUNTER_PORT |= _BV(LAP_COUNTER); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
617 | // TODO: beep long |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
618 | _delay_us(50); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
619 | LAP_COUNTER_PORT &= ~_BV(LAP_COUNTER); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
620 | } |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
621 | |
7
f4e250d5402b
fixes, bound lap counter reset to race start button
Malte Bayer <mbayer@neo-soft.org>
parents:
6
diff
changeset
|
622 | |
2
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
623 | switch (packet_index) { |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
624 | case 1: |
4
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
625 | if (program_count > 0) { |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
626 | // command in queue |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
627 | if (do_program(program_id, program_command, program_parameter)) { |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
628 | packet_index++; |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
629 | program_count--; |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
630 | } |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
631 | } else { |
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
632 | // output idle command |
11
69c2a1408619
done code for sniffing the rails
Malte Bayer <mbayer@neo-soft.org>
parents:
10
diff
changeset
|
633 | if (do_program(7, 19, 0)) packet_index++; // reset |
8 | 634 | //if (do_program(7, 20, 15)) packet_index++; // reset / pitstop detect |
11
69c2a1408619
done code for sniffing the rails
Malte Bayer <mbayer@neo-soft.org>
parents:
10
diff
changeset
|
635 | //if (insert_queue(0, 0)) packet_index++; // null command |
4
58529e14c45c
implemented rs232 program word injection
Malte Bayer <mbayer@neo-soft.org>
parents:
3
diff
changeset
|
636 | } |
37
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
637 | |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
638 | if ( (packet_index>1) && (mode == 2) ) countdown_progress(); |
136a79772098
implemented race prepare phase, countdown and jumpstart detection
Malte Bayer <mbayer@neo-soft.org>
parents:
36
diff
changeset
|
639 | |
2
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
640 | break; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
641 | case 2: |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
642 | if (do_pace_ghost()) packet_index++; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
643 | break; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
644 | case 3: |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
645 | if (do_active()) packet_index++; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
646 | break; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
647 | case 4: |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
648 | if (do_controller(0)) { packet_index++; |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
649 | slot_liveinfo(0); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
650 | } |
2
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
651 | break; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
652 | case 5: |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
653 | if (do_controller(4)) { packet_index++; |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
654 | slot_liveinfo(4); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
655 | } |
2
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
656 | break; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
657 | case 6: |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
658 | if (do_controller(1)) { packet_index++; |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
659 | slot_liveinfo(1); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
660 | } |
2
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
661 | break; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
662 | case 7: |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
663 | if (do_controller(5)) { packet_index++; |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
664 | slot_liveinfo(5); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
665 | } |
2
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
666 | break; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
667 | case 8: |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
668 | if (do_controller(2)) { packet_index++; |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
669 | slot_liveinfo(2); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
670 | } |
2
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
671 | break; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
672 | case 9: |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
673 | if (do_active()) packet_index++; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
674 | break; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
675 | case 10: |
59
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
676 | if (do_controller(3)) { packet_index = 1; |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
677 | slot_liveinfo(3); |
361bc4602cf7
added fuel management to blackbox, cars dont get stuck at the moment
Malte Bayer <mbayer@neo-soft.org>
parents:
53
diff
changeset
|
678 | } |
2
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
679 | // last packet, so reset packet index |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
680 | break; |
6c59b4293fa9
finished: rails short circuit check
Malte Bayer <mbayer@neo-soft.org>
parents:
0
diff
changeset
|
681 | } |
0
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
682 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
683 | |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
684 | } // main loop end |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
685 | }; |
9b7de464f0ea
initial commit - controller1 working
Malte Bayer <mbayer@neo-soft.org>
parents:
diff
changeset
|
686 |