freeslot: comparison blackbox/main.c

-:60c4b28fd773
+:ec888cfa024e
 // valid race modes:
 // 0: free drive / idle
 // 1: waiting for countdown start
 // 2: race countdown initiated
 // 3: Race start condition
+uint8_t  liveinfo = 0;
+uint8_t  fuel_enabled = 1;
 volatile u32 sysclk;
 volatile uint8_t sysclk_packettimer = 0;
 volatile cardata slot[MAX_SLOTS];
 volatile uint16_t responsewire_data = 0;
 volatile uint16_t response;
 volatile uint8_t response_len;
 volatile uint8_t timer0_delay;
+/* RESPONSEWIRE frame format:
+1 startbit
+2 car id bit 1
+3 car id bit 2
+4 car id bit 3
+5 track change status bit 1
+6 track change status bit 2
+7 track change status bit 3
+8 track change status bit 4
+9 sender id bit 1
+10 sender id bit 2
+11 sender id bit 3
+12 sender id bit 4
+13 device type bit 1
+14 device type bit 2
+15 device type bit 3
+16 stopbit
+*/
+/* PITLANE STATUS DEFINITION
+1 = AA
+2 = AB
+3 = BB
+4 = BA
+5 = BC
+6 = ZZ -> pitlane exit
+*/
+#define STARTSTOP 0b1000000000000001
+void decode_responsewire(void) {
+uint16_t data = responsewire_data;
+// first check if start + stopbit are set
+// todo future: unsure but last bit doesnt get set?!
+/*
+if ((data & STARTSTOP) != STARTSTOP) {
+RS232_puts("RW BAD\n");
+return; // incomplete response
+}
+*/
+// now extract the car id, track change status
+uint8_t car = ((data >> 1) & 0b111);
+uint8_t status = ((data >> 4) & 0b1111);
+uint8_t sender = ((data >> 8) & 0b1111);
+uint8_t type = ((data >> 12) & 0b111);
+if (type == 4) {
+// pitlane response
+if (status == 5) slot[car].canrefuel = 1;
+if (status == 6) for (data=0; data<MAX_SLOTS; data++) slot[data].canrefuel = 0;
+}
+RS232_puts("RW:");
+itoa(car, s, 16);
+RS232_puts(s);
+RS232_putc(':');
+itoa(type, s, 16);
+RS232_puts(s);
+RS232_putc(':');
+itoa(sender, s, 16);
+RS232_puts(s);
+RS232_putc(':');
+itoa(status, s, 16);
+RS232_puts(s);
+RS232_putc('\n');
+}
 int insert_queue(uint16_t tmp, uint8_t len) {
 if (transmit_buffer_queue == 0) {
 transmit_buffer_queue = tmp;
 transmit_len_queue = len;
 if (tmp > 9)
 tmp = buffer[2]-'A'+10;
 slot[buffer[1]-'0'].speedminimum = tmp;
 RS232_puts_p(ok);
 break;
+case 'F': // set fuel enabled
+fuel_enabled = buffer[1]-'0';
+RS232_puts_p(ok);
+break;
+case '*': // set live information
+liveinfo = buffer[1]-'0';
+RS232_puts_p(ok);
+break;
 case 'I': // get Information data (incl. important global parameter dump)
 RS232_puts(VERSION);
 RS232_putc(':');
 for (tmp=0;tmp<MAX_SLOTS;tmp++) RS232_putc(slot[tmp].speedlimit); // output speed limits
 tmp |=  (0b1000000000 | (controller << 6));
 // FUEL BIT GETS SET WHEN FUEL == 0,
 // THIS REQUIRES PHYSICAL CAR FUEL LEVEL SET TO ZERO BEFORE!
 if ( ((PIN(SW_FUEL_PORT) & _BV(SW_FUEL)) != 0) | (slot[controller].fuel == 0)) tmp |= 1; // benzinstand aktiv - tankmodusschalter
 if (insert_queue(tmp, 9)) {
-if (speed != 0) {
+if (fuel_enabled) {
-// do the fuel calculation, regardless if fuel logic active or not
+if (speed != 0) {
-tmp = (uint8_t)(((slot[controller].accel * speed) + 1) / FUEL_DIVISOR);
+// do the fuel calculation, regardless if fuel logic active or not
-if (tmp == 0) tmp = 1;
+tmp = (uint8_t)(((slot[controller].accel * speed) + 1) / FUEL_DIVISOR);
-if (slot[controller].fuel > 0) {
+if (tmp == 0) tmp = 1;
-// enough fuel left to decrement?
+if (slot[controller].fuel > 0) {
-if (slot[controller].fuel > tmp) {
+// enough fuel left to decrement?
-slot[controller].fuel -= tmp; // decrement fuel level
+if (slot[controller].fuel > tmp) {
-} else slot[controller].fuel = 0;
+slot[controller].fuel -= tmp; // decrement fuel level
+} else slot[controller].fuel = 0;
+}
+} else if (slot[controller].canrefuel) {
+// increase fuel by 5%/sec, this equals by adding 50 to the counter
+slot[controller].fuel += 50;
+if (slot[controller].fuel > FUEL_FULL) slot[controller].fuel = FUEL_FULL;
 }
-} else if (slot[controller].canrefuel) {
+return 1;
-// increase fuel by 5%/sec, this equals by adding 50 to the counter
+}
-slot[controller].fuel += 50;
-if (slot[controller].fuel > FUEL_FULL) slot[controller].fuel = FUEL_FULL;
-}
-return 1;
 } else return 0;
 }
 uint8_t mirror( uint8_t n ) {
 n = ((n >> 1) & 0x55) | ((n << 1) & 0xaa);
 slot[i].fuel = FUEL_FULL;
 slot[i].jumpstart_time = 0;
 slot[i].laps = 0;
 slot[i].seccnt = 0;
 slot[i].accel = 15; // full acceleration per default - TODO
-slot[i].canrefuel = 1; // TODO: only set to 1 when on a pitlane
+slot[i].canrefuel = 0;
 }
 sysclk.value = 0;
 }
 void countdown_progress(void) {
 if (slot[car0-1].lap_time_start.value != 0) {
 slot[car0-1].lap_time.value = diff.value;
 slot[car0-1].laps++;
 RS232_putc('L');
 RS232_putc(':');
-RS232_putc('A');
+RS232_putc('B');
 RS232_putc(':');
 itoa(slot[car0-1].laps, s, 16);
 RS232_puts(s);
 RS232_putc(':');
 RS232_putc('0'+car0_state);
 if (slot[car1-1].lap_time_start.value != 0) {
 slot[car1-1].lap_time.value = diff.value;
 slot[car1-1].laps++;
 RS232_putc('L');
 RS232_putc(':');
-RS232_putc('B');
+RS232_putc('A');
 RS232_putc(':');
 itoa(slot[car1-1].laps, s, 16);
 RS232_puts(s);
 RS232_putc(':');
 RS232_putc('0'+car1_state);
 }
 } car1 = 0;
 }
 void slot_liveinfo(uint8_t idx) {
+if (liveinfo == 0) return;
 // increment packet counter, if == 10 output some live info
 if (slot[idx].seccnt == 10) {
 // output current fuel status
 RS232_putc('F');
 RS232_putc(':');

Mercurial > hg-public > freeslot / file comparison

comparison: blackbox/main.c

blackbox/main.c