X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fkernel%2Fao_pyro.c;h=07a8278d560a85f4d913ccf7a735645131d31cc6;hb=db30a0dd958617cbe7fa8054ebb7b40ced90b602;hp=527112acfbfcbc1332464966f95ed5c47cbfac54;hpb=0d57c78dde3c6e61576a4769b0e0fae7e88c107d;p=fw%2Faltos diff --git a/src/kernel/ao_pyro.c b/src/kernel/ao_pyro.c index 527112ac..07a8278d 100644 --- a/src/kernel/ao_pyro.c +++ b/src/kernel/ao_pyro.c @@ -38,8 +38,8 @@ enum ao_igniter_status ao_pyro_status(uint8_t p) { - __xdata struct ao_data packet; - __pdata int16_t value; + struct ao_data packet; + int16_t value; ao_arch_critical( ao_data_get(&packet); @@ -69,6 +69,7 @@ ao_pyro_print_status(void) #endif uint16_t ao_pyro_fired; +uint16_t ao_pyro_inhibited; #ifndef PYRO_DBG #define PYRO_DBG 0 @@ -160,14 +161,14 @@ ao_pyro_ready(struct ao_pyro *pyro) #endif case ao_pyro_time_less: - if ((int16_t) (ao_time() - ao_launch_tick) <= pyro->time_less) + if ((int32_t) (ao_time() - ao_launch_tick) <= pyro->time_less) continue; - DBG("time %d > %d\n", (int16_t)(ao_time() - ao_launch_tick), pyro->time_less); + DBG("time %d > %d\n", (int32_t)(ao_time() - ao_launch_tick), pyro->time_less); break; case ao_pyro_time_greater: - if ((int16_t) (ao_time() - ao_launch_tick) >= pyro->time_greater) + if ((int32_t) (ao_time() - ao_launch_tick) >= pyro->time_greater) continue; - DBG("time %d < %d\n", (int16_t)(ao_time() - ao_launch_tick), pyro->time_greater); + DBG("time %d < %d\n", (int32_t)(ao_time() - ao_launch_tick), pyro->time_greater); break; case ao_pyro_ascending: @@ -205,9 +206,9 @@ ao_pyro_ready(struct ao_pyro *pyro) default: continue; } - return FALSE; + return false; } - return TRUE; + return true; } #ifndef AO_FLIGHT_TEST @@ -216,28 +217,28 @@ ao_pyro_pin_set(uint8_t p, uint8_t v) { switch (p) { #if AO_PYRO_NUM > 0 - case 0: ao_gpio_set(AO_PYRO_PORT_0, AO_PYRO_PIN_0, AO_PYRO_0, v); break; + case 0: ao_gpio_set(AO_PYRO_PORT_0, AO_PYRO_PIN_0, v); break; #endif #if AO_PYRO_NUM > 1 - case 1: ao_gpio_set(AO_PYRO_PORT_1, AO_PYRO_PIN_1, AO_PYRO_1, v); break; + case 1: ao_gpio_set(AO_PYRO_PORT_1, AO_PYRO_PIN_1, v); break; #endif #if AO_PYRO_NUM > 2 - case 2: ao_gpio_set(AO_PYRO_PORT_2, AO_PYRO_PIN_2, AO_PYRO_2, v); break; + case 2: ao_gpio_set(AO_PYRO_PORT_2, AO_PYRO_PIN_2, v); break; #endif #if AO_PYRO_NUM > 3 - case 3: ao_gpio_set(AO_PYRO_PORT_3, AO_PYRO_PIN_3, AO_PYRO_3, v); break; + case 3: ao_gpio_set(AO_PYRO_PORT_3, AO_PYRO_PIN_3, v); break; #endif #if AO_PYRO_NUM > 4 - case 4: ao_gpio_set(AO_PYRO_PORT_4, AO_PYRO_PIN_4, AO_PYRO_4, v); break; + case 4: ao_gpio_set(AO_PYRO_PORT_4, AO_PYRO_PIN_4, v); break; #endif #if AO_PYRO_NUM > 5 - case 5: ao_gpio_set(AO_PYRO_PORT_5, AO_PYRO_PIN_5, AO_PYRO_5, v); break; + case 5: ao_gpio_set(AO_PYRO_PORT_5, AO_PYRO_PIN_5, v); break; #endif #if AO_PYRO_NUM > 6 - case 6: ao_gpio_set(AO_PYRO_PORT_6, AO_PYRO_PIN_6, AO_PYRO_6, v); break; + case 6: ao_gpio_set(AO_PYRO_PORT_6, AO_PYRO_PIN_6, v); break; #endif #if AO_PYRO_NUM > 7 - case 7: ao_gpio_set(AO_PYRO_PORT_7, AO_PYRO_PIN_7, AO_PYRO_7, v); break; + case 7: ao_gpio_set(AO_PYRO_PORT_7, AO_PYRO_PIN_7, v); break; #endif default: break; } @@ -274,9 +275,9 @@ ao_pyro_check(void) for (p = 0; p < AO_PYRO_NUM; p++) { pyro = &ao_config.pyro[p]; - /* Ignore igniters which have already fired + /* Ignore igniters which have already fired or inhibited */ - if (ao_pyro_fired & (1 << p)) + if ((ao_pyro_fired|ao_pyro_inhibited) & (1 << p)) continue; /* Ignore disabled igniters @@ -308,14 +309,14 @@ ao_pyro_check(void) /* Check to make sure the required conditions * remain valid. If not, inhibit the channel - * by setting the fired bit + * by setting the inhibited bit */ if (!ao_pyro_ready(pyro)) { - ao_pyro_fired |= (1 << p); + ao_pyro_inhibited |= (1 << p); continue; } - if ((int16_t) (ao_time() - pyro->delay_done) < 0) + if ((int32_t) (ao_time() - pyro->delay_done) < 0) continue; } @@ -404,7 +405,7 @@ ao_pyro(void) ao_exit(); } -__xdata struct ao_task ao_pyro_task; +struct ao_task ao_pyro_task; static void @@ -430,6 +431,55 @@ ao_pyro_help(void) } #endif +static int32_t +ao_pyro_get(void *base, uint8_t offset, uint8_t size) +{ + int32_t value; + switch (size) { + case 8: + value = *((uint8_t *) ((char *) base + offset)); + break; + case 16: + default: + value = *((int16_t *) (void *) ((char *) base + offset)); + break; + case 32: + value = *((int32_t *) (void *) ((char *) base + offset)); + break; + } + return value; +} + +static bool +ao_pyro_put(void *base, uint8_t offset, uint8_t size, int32_t value) +{ + switch (size) { + case 8: + if (value < 0) + return false; + *((uint8_t *) ((char *) base + offset)) = value; + break; + case 16: + default: + *((int16_t *) (void *) ((char *) base + offset)) = value; + break; + case 32: + *((int32_t *) (void *) ((char *) base + offset)) = value; + break; + } + return true; +} + +static uint8_t +ao_pyro_size(enum ao_pyro_flag flag) +{ + if (flag & AO_PYRO_8_BIT_VALUE) + return 8; + if (flag & AO_PYRO_32_BIT_VALUE) + return 32; + return 16; +} + void ao_pyro_show(void) { @@ -450,13 +500,10 @@ ao_pyro_show(void) continue; ao_pyro_print_name(v); if (ao_pyro_values[v].offset != NO_VALUE) { - int16_t value; - - if (ao_pyro_values[v].flag & AO_PYRO_8_BIT_VALUE) - value = *((uint8_t *) ((char *) pyro + ao_pyro_values[v].offset)); - else - value = *((int16_t *) (void *) ((char *) pyro + ao_pyro_values[v].offset)); - printf ("%6d ", value); + printf ("%6ld ", + (long) ao_pyro_get(pyro, + ao_pyro_values[v].offset, + ao_pyro_size(ao_pyro_values[v].flag))); } else { printf (" "); } @@ -484,10 +531,9 @@ ao_pyro_set(void) } #endif - ao_cmd_decimal(); + p = ao_cmd_decimal(); if (ao_cmd_status != ao_cmd_success) return; - p = ao_cmd_lex_i; if (AO_PYRO_NUM <= p) { printf ("invalid pyro channel %d\n", p); return; @@ -516,25 +562,20 @@ ao_pyro_set(void) } pyro_tmp.flags |= ao_pyro_values[v].flag; if (ao_pyro_values[v].offset != NO_VALUE) { - uint8_t negative = 0; + int32_t r = 1; ao_cmd_white(); if (ao_cmd_lex_c == '-') { - negative = 1; + r = -1; ao_cmd_lex(); } - ao_cmd_decimal(); + r *= ao_cmd_decimal(); if (ao_cmd_status != ao_cmd_success) return; - if (ao_pyro_values[v].flag & AO_PYRO_8_BIT_VALUE) { - if (negative) { - ao_cmd_status = ao_cmd_syntax_error; - return; - } - *((uint8_t *) ((char *) &pyro_tmp + ao_pyro_values[v].offset)) = ao_cmd_lex_i; - } else { - if (negative) - ao_cmd_lex_i = -ao_cmd_lex_i; - *((int16_t *) (void *) ((char *) &pyro_tmp + ao_pyro_values[v].offset)) = ao_cmd_lex_i; + if (!ao_pyro_put(&pyro_tmp, ao_pyro_values[v].offset, + ao_pyro_size(ao_pyro_values[v].flag), r)) + { + ao_cmd_status = ao_cmd_syntax_error; + return; } } } @@ -554,32 +595,114 @@ ao_pyro_manual(uint8_t p) ao_pyro_pins_fire(1 << p); } +struct ao_pyro_old_values { + enum ao_pyro_flag flag; + uint8_t offset; + uint8_t size; +}; + +static const struct ao_pyro_old_values ao_pyro_1_24_values[] = { + { .flag = ao_pyro_accel_less, .offset = offsetof(struct ao_pyro_1_24, accel_less), 16 }, + { .flag = ao_pyro_accel_greater, .offset = offsetof(struct ao_pyro_1_24, accel_greater), 16 }, + { .flag = ao_pyro_speed_less, .offset = offsetof(struct ao_pyro_1_24, speed_less), 16 }, + { .flag = ao_pyro_speed_greater, .offset = offsetof(struct ao_pyro_1_24, speed_greater), 16 }, + { .flag = ao_pyro_height_less, .offset = offsetof(struct ao_pyro_1_24, height_less), 16 }, + { .flag = ao_pyro_height_greater, .offset = offsetof(struct ao_pyro_1_24, height_greater), 16 }, + { .flag = ao_pyro_orient_less, .offset = offsetof(struct ao_pyro_1_24, orient_less), 16 }, + { .flag = ao_pyro_orient_greater, .offset = offsetof(struct ao_pyro_1_24, orient_greater), 16 }, + { .flag = ao_pyro_time_less, .offset = offsetof(struct ao_pyro_1_24, time_less), 16 }, + { .flag = ao_pyro_time_greater, .offset = offsetof(struct ao_pyro_1_24, time_greater), 16 }, + { .flag = ao_pyro_delay, .offset = offsetof(struct ao_pyro_1_24, delay), 16 }, + { .flag = ao_pyro_state_less, .offset = offsetof(struct ao_pyro_1_24, state_less), 8 }, + { .flag = ao_pyro_state_greater_or_equal, .offset = offsetof(struct ao_pyro_1_24, state_greater_or_equal), 8 }, + { .flag = ao_pyro_after_motor, .offset = offsetof(struct ao_pyro_1_24, motor), 16 }, +}; + +#define NUM_PYRO_1_24_VALUES (sizeof ao_pyro_1_24_values / sizeof ao_pyro_1_24_values[0]) + +static int32_t +ao_pyro_get_1_24(void *base, enum ao_pyro_flag flag) +{ + unsigned v; + + for (v = 0; v < NUM_PYRO_1_24_VALUES; v++) { + if (ao_pyro_1_24_values[v].flag == flag) + return ao_pyro_get(base, ao_pyro_1_24_values[v].offset, ao_pyro_1_24_values[v].size); + } + return 0; +} + +void +ao_pyro_update_version(void) +{ + if (ao_config.minor <= 24) + { + + /* First, move all of the config bits that follow the pyro data */ + + char *pyro_base = (void *) &ao_config.pyro; + char *after_pyro_new = pyro_base + AO_PYRO_NUM * sizeof (struct ao_pyro); + char *after_pyro_1_24 = pyro_base + AO_PYRO_NUM * sizeof (struct ao_pyro_1_24); + char *config_end = (void *) (&ao_config + 1); + size_t to_move = config_end - after_pyro_new; + + memmove(after_pyro_new, after_pyro_1_24, to_move); + + /* Now, adjust all of the pyro entries */ + + struct ao_pyro *pyro_new = ao_config.pyro; + struct ao_pyro_1_24 *pyro_old = (void *) ao_config.pyro; + + int p = AO_PYRO_NUM; + + /* New struct is larger than the old, so start at the + * last one and work towards the first + */ + while (p-- > 0) { + unsigned v; + int32_t value; + struct ao_pyro tmp; + + memset(&tmp, '\0', sizeof(tmp)); + tmp.flags = pyro_old[p].flags; + + for (v = 0; v < NUM_PYRO_VALUES; v++) + { + value = ao_pyro_get_1_24(&pyro_old[v], ao_pyro_values[v].flag); + ao_pyro_put(&tmp, ao_pyro_values[v].offset, + ao_pyro_size(ao_pyro_values[v].flag), value); + } + memcpy(&pyro_new[p], &tmp, sizeof(tmp)); + } + } +} + void ao_pyro_init(void) { #if AO_PYRO_NUM > 0 - ao_enable_output(AO_PYRO_PORT_0, AO_PYRO_PIN_0, AO_PYRO_0, 0); + ao_enable_output(AO_PYRO_PORT_0, AO_PYRO_PIN_0, 0); #endif #if AO_PYRO_NUM > 1 - ao_enable_output(AO_PYRO_PORT_1, AO_PYRO_PIN_1, AO_PYRO_1, 0); + ao_enable_output(AO_PYRO_PORT_1, AO_PYRO_PIN_1, 0); #endif #if AO_PYRO_NUM > 2 - ao_enable_output(AO_PYRO_PORT_2, AO_PYRO_PIN_2, AO_PYRO_2, 0); + ao_enable_output(AO_PYRO_PORT_2, AO_PYRO_PIN_2, 0); #endif #if AO_PYRO_NUM > 3 - ao_enable_output(AO_PYRO_PORT_3, AO_PYRO_PIN_3, AO_PYRO_3, 0); + ao_enable_output(AO_PYRO_PORT_3, AO_PYRO_PIN_3, 0); #endif #if AO_PYRO_NUM > 4 - ao_enable_output(AO_PYRO_PORT_4, AO_PYRO_PIN_4, AO_PYRO_4, 0); + ao_enable_output(AO_PYRO_PORT_4, AO_PYRO_PIN_4, 0); #endif #if AO_PYRO_NUM > 5 - ao_enable_output(AO_PYRO_PORT_5, AO_PYRO_PIN_5, AO_PYRO_5, 0); + ao_enable_output(AO_PYRO_PORT_5, AO_PYRO_PIN_5, 0); #endif #if AO_PYRO_NUM > 6 - ao_enable_output(AO_PYRO_PORT_6, AO_PYRO_PIN_6, AO_PYRO_6, 0); + ao_enable_output(AO_PYRO_PORT_6, AO_PYRO_PIN_6, 0); #endif #if AO_PYRO_NUM > 7 - ao_enable_output(AO_PYRO_PORT_7, AO_PYRO_PIN_7, AO_PYRO_7, 0); + ao_enable_output(AO_PYRO_PORT_7, AO_PYRO_PIN_7, 0); #endif ao_add_task(&ao_pyro_task, ao_pyro, "pyro"); }