- spickle_state = 0;
-}
-
-void spickle_auto(void)
-{
- spickle_state = WAIT_SENSOR;
- cs_set_consign(&cobboard.left_spickle.cs, spickle_pos_up);
-}
-
-/* for spickle auto mode */
-static void spickle_cb(__attribute__((unused)) void *dummy)
-{
- static uint8_t prev = 0;
- uint8_t val;
-
- val = sensor_get(S_LCOB);
-
- switch (spickle_state) {
- case OFF:
- break;
- case WAIT_SENSOR:
- if (val && !prev) {
- delay = spickle_delay_up;
- spickle_state = SENSOR_OK;
- }
- break;
- case SENSOR_OK:
- if (delay-- == 0) {
- cs_set_consign(&cobboard.left_spickle.cs, spickle_pos_down);
- spickle_state = WAIT_DOWN;
- delay = spickle_delay_down;
- }
- break;
- case WAIT_DOWN:
- if (delay-- == 0) {
- cs_set_consign(&cobboard.left_spickle.cs, spickle_pos_up);
- spickle_state = WAIT_SENSOR;
- }
- break;
- default:
- break;
- }
- prev = val;