mirror of
https://github.com/linux-msm/cdba.git
synced 2026-02-25 13:11:56 -08:00
bde90b4a15
Replace all license headers with the SPDX-License-Identitier headers to follow the current recommendations. Signed-off-by: Dmitry Baryshkov <dmitry.baryshkov@linaro.org>
105 lines
2.6 KiB
C
105 lines
2.6 KiB
C
/*
|
|
* Copyright (c) 2023, Linaro Ltd.
|
|
* All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
#define _GNU_SOURCE
|
|
#include <ctype.h>
|
|
#include <err.h>
|
|
#include <errno.h>
|
|
#include <fcntl.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <stdbool.h>
|
|
|
|
/* local-gpio implementation for libgpiod major version 2 */
|
|
|
|
#include "local-gpio.h"
|
|
|
|
#include <gpiod.h>
|
|
|
|
int local_gpio_init(struct local_gpio *local_gpio)
|
|
{
|
|
struct gpiod_request_config *req_cfg;
|
|
int i;
|
|
|
|
req_cfg = gpiod_request_config_new();
|
|
if (!req_cfg) {
|
|
err(1, "Unable to allocate request config");
|
|
return -1;
|
|
}
|
|
gpiod_request_config_set_consumer(req_cfg, "cdba");
|
|
|
|
for (i = 0; i < GPIO_COUNT; ++i) {
|
|
struct gpiod_line_settings *line_settings;
|
|
struct gpiod_line_config *line_cfg;
|
|
char *gpiochip_path;
|
|
|
|
if (!local_gpio->options->gpios[i].present)
|
|
continue;
|
|
|
|
if (asprintf(&gpiochip_path, "/dev/%s", local_gpio->options->gpios[i].chip) < 0) {
|
|
free(local_gpio);
|
|
return -1;
|
|
}
|
|
|
|
local_gpio->gpios[i].chip = gpiod_chip_open(gpiochip_path);
|
|
if (!local_gpio->gpios[i].chip) {
|
|
err(1, "Unable to open gpiochip '%s'", local_gpio->options->gpios[i].chip);
|
|
return -1;
|
|
}
|
|
|
|
line_settings = gpiod_line_settings_new();
|
|
if (!line_settings) {
|
|
err(1, "Unable to allocate gpio line settings");
|
|
return -1;
|
|
}
|
|
if (gpiod_line_settings_set_direction(line_settings,
|
|
GPIOD_LINE_DIRECTION_OUTPUT) < 0) {
|
|
err(1, "Unable to set line direction");
|
|
return -1;
|
|
}
|
|
if (local_gpio->options->gpios[i].active_low)
|
|
gpiod_line_settings_set_active_low(line_settings, true);
|
|
if (gpiod_line_settings_set_output_value(line_settings,
|
|
GPIOD_LINE_VALUE_INACTIVE) < 0) {
|
|
err(1, "Unable to set line output value");
|
|
return -1;
|
|
}
|
|
|
|
line_cfg = gpiod_line_config_new();
|
|
if (!line_cfg) {
|
|
err(1, "Unable to allocate gpio line settings");
|
|
return -1;
|
|
}
|
|
if (gpiod_line_config_add_line_settings(line_cfg,
|
|
&local_gpio->options->gpios[i].offset, 1,
|
|
line_settings) < 0) {
|
|
err(1, "Unable to set line config");
|
|
return -1;
|
|
}
|
|
|
|
local_gpio->gpios[i].line = gpiod_chip_request_lines(local_gpio->gpios[i].chip,
|
|
req_cfg, line_cfg);
|
|
|
|
if (!local_gpio->gpios[i].line) {
|
|
err(1, "Unable to request gpio %d offset %u",
|
|
i, local_gpio->options->gpios[i].offset);
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int local_gpio_set_value(struct local_gpio *local_gpio, unsigned int gpio, bool on)
|
|
{
|
|
return gpiod_line_request_set_value(local_gpio->gpios[gpio].line,
|
|
local_gpio->options->gpios[gpio].offset,
|
|
on ? GPIOD_LINE_VALUE_ACTIVE
|
|
: GPIOD_LINE_VALUE_INACTIVE);
|
|
}
|