60 lines
1.3 KiB
C
60 lines
1.3 KiB
C
#include "utils/user_log_util.h"
|
|
|
|
#include "drivers/user_gpio_driver.h"
|
|
|
|
|
|
int user_gpio_init(user_gpio_t *gpio, char *chip, uint32_t offset, uint8_t output_enabled) {
|
|
|
|
gpio->chip = gpiod_chip_open(chip);
|
|
if(gpio->chip == NULL) {
|
|
USER_LOG(USER_LOG_ERROR, "Failed to open chip %s.", chip);
|
|
return -1;
|
|
}
|
|
|
|
gpio->line = gpiod_chip_get_line(gpio->chip, offset);
|
|
if(gpio->line == NULL) {
|
|
USER_LOG(USER_LOG_ERROR, "Failed to get GPIO line %d.", offset);
|
|
gpiod_chip_close(gpio->chip);
|
|
return -1;
|
|
}
|
|
|
|
int ret;
|
|
|
|
if(output_enabled) {
|
|
ret = gpiod_line_request_output(gpio->line, "SA", 1);
|
|
} else {
|
|
gpiod_line_request_input(gpio->line, "SA");
|
|
}
|
|
|
|
if(ret != 0) {
|
|
USER_LOG(USER_LOG_ERROR, "Failed to reserve GPIO line.");
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int user_gpio_set(user_gpio_t *gpio, uint8_t value) {
|
|
int ret = gpiod_line_set_value(gpio->line, value);
|
|
|
|
if(ret != 0) {
|
|
USER_LOG(USER_LOG_ERROR, "Failed to set GPIO value.");
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int user_gpio_get(user_gpio_t *gpio, uint8_t *value){
|
|
*value = gpiod_line_get_value(gpio->line);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int user_gpio_deinit(user_gpio_t *gpio) {
|
|
|
|
gpiod_line_release(gpio->line);
|
|
gpiod_chip_close(gpio->chip);
|
|
|
|
return 0;
|
|
} |