26 lines
377 B
C
26 lines
377 B
C
#include "bsp_gpio.h"
|
|
|
|
#include <stdlib.h>
|
|
|
|
#include "webots/led.h"
|
|
|
|
static WbDeviceTag led = 0;
|
|
|
|
inline bsp_status_t bsp_gpio_write_pin(bsp_gpio_t gpio, bool value) {
|
|
(void)gpio;
|
|
|
|
if (!led) {
|
|
led = wb_robot_get_device("led");
|
|
}
|
|
|
|
if (value) {
|
|
wb_led_set(led, 1);
|
|
return BSP_OK;
|
|
} else {
|
|
wb_led_set(led, 0);
|
|
return BSP_OK;
|
|
}
|
|
|
|
return BSP_ERR;
|
|
}
|