diff options
Diffstat (limited to 'src/arch/posix/driver/gpio.cc')
-rw-r--r-- | src/arch/posix/driver/gpio.cc | 31 |
1 files changed, 31 insertions, 0 deletions
diff --git a/src/arch/posix/driver/gpio.cc b/src/arch/posix/driver/gpio.cc new file mode 100644 index 0000000..25eed39 --- /dev/null +++ b/src/arch/posix/driver/gpio.cc @@ -0,0 +1,31 @@ +#include "driver/gpio.h" +#include <stdio.h> + +void GPIO::led_on(unsigned char id) +{ + if (id < 8) { + printf("▶ LED %3d on\n", id); + ledstate |= (1 << id); + } +} + +void GPIO::led_off(unsigned char id) +{ + if (id < 8) { + printf("▶ LED %3d off\n", id); + ledstate &= ~(1 << id); + } +} + +void GPIO::led_toggle(unsigned char id) +{ + if (id < 8) { + if (ledstate & (1 << id)) { + led_off(id); + } else { + led_on(id); + } + } +} + +GPIO gpio; |