mirror of
https://gitlab.com/fabinfra/fabhardware/fablock-kallax.git
synced 2025-04-21 02:26:26 +02:00
first test
This commit is contained in:
parent
cf395f9c86
commit
b8a5375060
38
main/main.c
38
main/main.c
@ -82,9 +82,17 @@ void trigger(int id)
|
|||||||
|
|
||||||
for(int i = 0; i < 5; i++)
|
for(int i = 0; i < 5; i++)
|
||||||
{
|
{
|
||||||
gpio_set_level(PIN_GND[i], 0);
|
gpio_set_level(PIN_GND[i], 1);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
gpio_set_level(PIN_LED[id/5], 1);
|
||||||
|
gpio_set_level(PIN_GND[id%5], 0);
|
||||||
|
vTaskDelay(pdMS_TO_TICKS(250));
|
||||||
|
|
||||||
|
for(int i = 0; i < 5; i++)
|
||||||
|
{
|
||||||
|
gpio_set_level(PIN_GND[i], 0);
|
||||||
|
}
|
||||||
gpio_set_level(PIN_LOCK[id/5], 1);
|
gpio_set_level(PIN_LOCK[id/5], 1);
|
||||||
gpio_set_level(PIN_GND[id%5], 1);
|
gpio_set_level(PIN_GND[id%5], 1);
|
||||||
|
|
||||||
@ -92,6 +100,21 @@ void trigger(int id)
|
|||||||
|
|
||||||
gpio_set_level(PIN_LOCK[id/5], 0);
|
gpio_set_level(PIN_LOCK[id/5], 0);
|
||||||
gpio_set_level(PIN_GND[id%5], 0);
|
gpio_set_level(PIN_GND[id%5], 0);
|
||||||
|
|
||||||
|
for(int i = 0; i < 5; i++)
|
||||||
|
{
|
||||||
|
gpio_set_level(PIN_GND[i], 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
gpio_set_level(PIN_LED[id/5], 1);
|
||||||
|
gpio_set_level(PIN_GND[id%5], 0);
|
||||||
|
vTaskDelay(pdMS_TO_TICKS(500));
|
||||||
|
|
||||||
|
gpio_set_level(PIN_LED[id/5], 0);
|
||||||
|
for(int i = 0; i < 5; i++)
|
||||||
|
{
|
||||||
|
gpio_set_level(PIN_GND[i], 0);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void identify(int id)
|
void identify(int id)
|
||||||
@ -109,13 +132,22 @@ void identify(int id)
|
|||||||
gpio_set_level(PIN_GND[i], 1);
|
gpio_set_level(PIN_GND[i], 1);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
for(int i = 0; i < 3; i++)
|
||||||
|
{
|
||||||
gpio_set_level(PIN_LED[id/5], 1);
|
gpio_set_level(PIN_LED[id/5], 1);
|
||||||
gpio_set_level(PIN_GND[id%5], 0);
|
gpio_set_level(PIN_GND[id%5], 0);
|
||||||
|
vTaskDelay(pdMS_TO_TICKS(250));
|
||||||
vTaskDelay(pdMS_TO_TICKS(100));
|
|
||||||
|
|
||||||
gpio_set_level(PIN_LED[id/5], 0);
|
gpio_set_level(PIN_LED[id/5], 0);
|
||||||
gpio_set_level(PIN_GND[id%5], 1);
|
gpio_set_level(PIN_GND[id%5], 1);
|
||||||
|
vTaskDelay(pdMS_TO_TICKS(250));
|
||||||
|
}
|
||||||
|
|
||||||
|
gpio_set_level(PIN_LED[id/5], 0);
|
||||||
|
for(int i = 0; i < 5; i++)
|
||||||
|
{
|
||||||
|
gpio_set_level(PIN_GND[i], 0);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
Loading…
x
Reference in New Issue
Block a user