diff options
Diffstat (limited to 'meta-facebook/meta-yosemite/recipes-yosemite/gpiod/files')
3 files changed, 412 insertions, 0 deletions
diff --git a/meta-facebook/meta-yosemite/recipes-yosemite/gpiod/files/Makefile b/meta-facebook/meta-yosemite/recipes-yosemite/gpiod/files/Makefile new file mode 100644 index 0000000..68e9453 --- /dev/null +++ b/meta-facebook/meta-yosemite/recipes-yosemite/gpiod/files/Makefile @@ -0,0 +1,26 @@ +# Copyright 2015-present Facebook. All Rights Reserved. +# +# This program file is free software; you can redistribute it and/or modify it +# under the terms of the GNU General Public License as published by the +# Free Software Foundation; version 2 of the License. +# +# This program is distributed in the hope that it will be useful, but WITHOUT +# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or +# FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License +# for more details. +# +# You should have received a copy of the GNU General Public License +# along with this program in a file named COPYING; if not, write to the +# Free Software Foundation, Inc., +# 51 Franklin Street, Fifth Floor, +# Boston, MA 02110-1301 USA + +all: gpiod + +sensord: gpiod.c + $(CC) $(CFLAGS) -D _XOPEN_SOURCE -pthread -lm -std=c99 -o $@ $^ $(LDFLAGS) + +.PHONY: clean + +clean: + rm -rf *.o gpiod diff --git a/meta-facebook/meta-yosemite/recipes-yosemite/gpiod/files/gpiod.c b/meta-facebook/meta-yosemite/recipes-yosemite/gpiod/files/gpiod.c new file mode 100644 index 0000000..9282e00 --- /dev/null +++ b/meta-facebook/meta-yosemite/recipes-yosemite/gpiod/files/gpiod.c @@ -0,0 +1,353 @@ +/* + * sensord + * + * Copyright 2015-present Facebook. All Rights Reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. + */ + +#include <stdio.h> +#include <stdlib.h> +#include <stdbool.h> +#include <unistd.h> +#include <errno.h> +#include <syslog.h> +#include <stdint.h> +#include <math.h> +#include <string.h> +#include <pthread.h> +#include <sys/un.h> +#include <sys/file.h> +#include <openbmc/ipmi.h> +#include <openbmc/pal.h> +#include <facebook/bic.h> +#include <facebook/yosemite_gpio.h> + +#define SETBIT(x, y) (x | (1 << y)) +#define GETBIT(x, y) ((x & (1 << y)) > y) +#define CLEARBIT(x, y) (x & (~(1 << y))) +#define GETMASK(y) (1 << y) + +#define MAX_NUM_SLOTS 4 +#define GPIOD_READ_DELAY 1 +#define SOCK_PATH_GPIO "/tmp/gpio_socket" + +/* To hold the gpio info and status */ +typedef struct { + uint8_t flag; + uint8_t status; + uint8_t ass_val; + char name[32]; +} gpio_pin_t; + +static gpio_pin_t gpio_slot1[MAX_GPIO_PINS] = {0}; +static gpio_pin_t gpio_slot2[MAX_GPIO_PINS] = {0}; +static gpio_pin_t gpio_slot3[MAX_GPIO_PINS] = {0}; +static gpio_pin_t gpio_slot4[MAX_GPIO_PINS] = {0}; + +/* Returns the pointer to the struct holding all gpio info for the fru#. */ +static gpio_pin_t * +get_struct_gpio_pin(uint8_t fru) { + + gpio_pin_t *gpios; + + switch (fru) { + case FRU_SLOT1: + gpios = gpio_slot1; + break; + case FRU_SLOT2: + gpios = gpio_slot2; + break; + case FRU_SLOT3: + gpios = gpio_slot3; + break; + case FRU_SLOT4: + gpios = gpio_slot4; + break; + default: + syslog(LOG_ALERT, "get_struct_gpio_pin: Wrong SLOT ID %d\n", fru); + return NULL; + } + + return gpios; +} + +int +enable_gpio_intr_config(uint8_t fru, uint8_t gpio) { + int ret; + + bic_gpio_config_t cfg = {0}; + bic_gpio_config_t verify_cfg = {0}; + + + ret = bic_get_gpio_config(fru, gpio, &cfg); + if (ret < 0) { + syslog(LOG_ERR, "enable_gpio_intr_config: bic_get_gpio_config failed" + "for slot_id: %u, gpio pin: %u", fru, gpio); + return -1; + } + + cfg.ie = 1; + + ret = bic_set_gpio_config(fru, gpio, &cfg); + if (ret < 0) { + syslog(LOG_ERR, "enable_gpio_intr_config: bic_set_gpio_config failed" + "for slot_id: %u, gpio pin: %u", fru, gpio); + return -1; + } + + ret = bic_get_gpio_config(fru, gpio, &verify_cfg); + if (ret < 0) { + syslog(LOG_ERR, "enable_gpio_intr_config: verification bic_get_gpio_config" + "for slot_id: %u, gpio pin: %u", fru, gpio); + return -1; + } + + if (verify_cfg.ie != cfg.ie) { + syslog(LOG_ALERT, "Slot_id: %u,Interrupt enabling FAILED for GPIO pin# %d", + fru, gpio); + return -1; + } + + return 0; +} + +/* Enable the interrupt mode for all the gpio sensors */ +static void +enable_gpio_intr(uint8_t fru) { + + int i, ret; + gpio_pin_t *gpios; + + gpios = get_struct_gpio_pin(fru); + if (gpios == NULL) { + syslog(LOG_ALERT, "enable_gpio_intr: get_struct_gpio_pin failed."); + return; + } + + for (i = 0; i < gpio_pin_cnt; i++) { + ret = enable_gpio_intr_config(fru, gpio_pin_list[i]); + if (ret < 0) { + gpios[i].flag = 0; + syslog(LOG_ALERT, "enable_gpio_intr: Slot: %d, Pin %d interrupt enabling" + " failed", fru, gpio_pin_list[i]); + syslog(LOG_ALERT, "enable_gpio_intr: Disable check for Slot %d, Pin %d", + fru, gpio_pin_list[i]); + } else { + gpios[i].flag = 1; +#ifdef DEBUG + syslog(LOG_ALERT, "enable_gpio_intr: Enabled check for Slot: %d, Pin %d", + fru, gpio_pin_list[i]); +#endif /* DEBUG */ + } + } +} + +static void +populate_gpio_pins(uint8_t fru) { + + int i, ret; + + gpio_pin_t *gpios; + + gpios = get_struct_gpio_pin(fru); + if (gpios == NULL) { + syslog(LOG_ALERT, "populate_gpio_pins: get_struct_gpio_pin failed."); + return; + } + + for(i = 0; i < gpio_pin_cnt; i++) { + gpios[gpio_pin_list[i]].flag = 1; + } + + + for(i = 0; i < MAX_GPIO_PINS; i++) { + if (gpios[i].flag) { + gpios[i].ass_val = GETBIT(gpio_ass_val, i); + ret = yosemite_get_gpio_name(fru, i, gpios[i].name); + if (ret < 0) + continue; + } + } +} + +/* Wrapper function to configure and get all gpio info */ +static void +init_gpio_pins() { + int fru; + + for (fru = FRU_SLOT1; fru < (FRU_SLOT1 + MAX_NUM_SLOTS); fru++) { + populate_gpio_pins(fru); + } +} + +/* Monitor the gpio pins */ +static int +gpio_monitor_poll(uint8_t fru_flag) { + int i, ret; + uint8_t fru; + uint32_t revised_pins, n_pin_val, o_pin_val[MAX_NUM_SLOTS + 1] = {0}; + gpio_pin_t *gpios; + + uint32_t status; + bic_gpio_t gpio = {0}; + + /* Check for initial Asserts */ + for (fru = 1; fru <= MAX_NUM_SLOTS; fru++) { + if (GETBIT(fru_flag, fru) == 0) + continue; + + ret = bic_get_gpio(fru, &gpio); + if (ret) { + syslog(LOG_ALERT, "populate_gpio_pins: bic_get_gpio failed for " + " fru %u", fru); + continue; + } + + gpios = get_struct_gpio_pin(fru); + if (gpios == NULL) { + syslog(LOG_ALERT, "gpio_monitor_poll: get_struct_gpio_pin failed for" + " fru %u", fru); + continue; + } + + memcpy(&status, (uint8_t *) &gpio, sizeof(status)); + + o_pin_val[fru] = 0; + + for (i = 0; i <= MAX_GPIO_PINS; i++) { + + if (gpios[i].flag == 0) + continue; + + gpios[i].status = GETBIT(status, i); + + if (gpios[i].status) + o_pin_val[fru] = SETBIT(o_pin_val[fru], i); + + if (gpios[i].status == gpios[i].ass_val) { + syslog(LOG_CRIT, "ASSERT: fru: %u, gpio pin: %-20s, num: %d", + fru, gpios[i].name, i); + } + } + } + + /* Keep monitoring each fru's gpio pins every 4 * GPIOD_READ_DELAY seconds */ + while(1) { + for (fru = 1; fru <= MAX_NUM_SLOTS; fru++) { + if (!(GETBIT(fru_flag, fru))) { + sleep(GPIOD_READ_DELAY); + continue; + } + + gpios = get_struct_gpio_pin(fru); + if (gpios == NULL) { + syslog(LOG_ALERT, "gpio_monitor_poll: get_struct_gpio_pin failed for" + " fru %u", fru); + continue; + } + + if ((ret = bic_get_gpio(fru, (bic_gpio_t *) &n_pin_val)) < 0) { + syslog(LOG_ALERT, "gpio_monitor_poll: bic_get_gpio failed for " + " fru %u", fru); + continue; + } + + if (o_pin_val[fru] == n_pin_val) { + o_pin_val[fru] = n_pin_val; + sleep(GPIOD_READ_DELAY); + continue; + } + + revised_pins = (n_pin_val ^ o_pin_val[fru]); + + for (i = 0; i < MAX_GPIO_PINS; i++) { + if (GETBIT(revised_pins, i) & gpios[i].flag) { + gpios[i].status = GETBIT(n_pin_val, i); + + // Check if the new GPIO val is ASSERT + if (gpios[i].status == gpios[i].ass_val) { + syslog(LOG_CRIT, "ASSERT: fru: %u, gpio pin: %-20s, num: %d", + fru, gpios[i].name, i); + } else { + syslog(LOG_CRIT, "DEASSERT: fru: %u, gpio pin: %-20s, num: %d", + fru, gpios[i].name, i); + } + } + } + + o_pin_val[fru] = n_pin_val; + sleep(GPIOD_READ_DELAY); + + } /* For Loop for each fru */ + } /* while loop */ +} /* function definition*/ + +static void +print_usage() { + printf("Usage: gpiod [ %s ]\n", "slot1, slot2, slot3, slot4"); +} + +/* Spawns a pthread for each fru to monitor all the sensors on it */ +static void +run_gpiod(int argc, void **argv) { + + //gpio_monitor(); + + int i, ret; + uint8_t fru_flag, fru; + + /* Check for which fru do we need to monitor the gpio pins */ + fru_flag = 0; + for (i = 1; i < argc; i++) { + ret = pal_get_fru_id(argv[i], &fru); + if (ret < 0) { + print_usage(); + exit(-1); + } + fru_flag = SETBIT(fru_flag, fru); + } + + gpio_monitor_poll(fru_flag); +} + +int +main(int argc, void **argv) { + int dev, rc, pid_file; + + if (argc < 2) { + print_usage(); + exit(-1); + } + + pid_file = open("/var/run/gpiod.pid", O_CREAT | O_RDWR, 0666); + rc = flock(pid_file, LOCK_EX | LOCK_NB); + if(rc) { + if(EWOULDBLOCK == errno) { + printf("Another gpiod instance is running...\n"); + exit(-1); + } + } else { + + init_gpio_pins(); + + daemon(0,1); + openlog("gpiod", LOG_CONS, LOG_DAEMON); + syslog(LOG_INFO, "gpiod: daemon started"); + run_gpiod(argc, argv); + } + + return 0; +} diff --git a/meta-facebook/meta-yosemite/recipes-yosemite/gpiod/files/setup-gpiod.sh b/meta-facebook/meta-yosemite/recipes-yosemite/gpiod/files/setup-gpiod.sh new file mode 100644 index 0000000..9e532f2 --- /dev/null +++ b/meta-facebook/meta-yosemite/recipes-yosemite/gpiod/files/setup-gpiod.sh @@ -0,0 +1,33 @@ +#!/bin/sh +# +# Copyright 2015-present Facebook. All Rights Reserved. +# +# This program file is free software; you can redistribute it and/or modify it +# under the terms of the GNU General Public License as published by the +# Free Software Foundation; version 2 of the License. +# +# This program is distributed in the hope that it will be useful, but WITHOUT +# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or +# FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License +# for more details. +# +# You should have received a copy of the GNU General Public License +# along with this program in a file named COPYING; if not, write to the +# Free Software Foundation, Inc., +# 51 Franklin Street, Fifth Floor, +# Boston, MA 02110-1301 USA +# + +### BEGIN INIT INFO +# Provides: setup-sensord +# Required-Start: +# Required-Stop: +# Default-Start: S +# Default-Stop: +# Short-Description: Setup sensor monitoring +### END INIT INFO + +# TODO: check for the if slot/server is present before starting the daemon +echo -n "Setup gpio monitoring for yosemite... " +/usr/local/bin/gpiod slot1 slot2 slot3 slot4 +echo "done." |
