143 lines
3.3 KiB
Plaintext
143 lines
3.3 KiB
Plaintext
|
#!/bin/bash
|
||
|
|
|
||
|
|
declare -g GPIOS
|
||
|
|
declare -g LEDS
|
||
|
|
|
||
|
|
set -e
|
||
|
|
|
||
|
|
RP=$(realpath "${0}")
|
||
|
|
SCRIPTPATH=$(dirname "${RP}")
|
||
|
|
|
||
|
|
# shellcheck source=/dev/null
|
||
|
|
source "${SCRIPTPATH}/libjethubconfig.sh"
|
||
|
|
|
||
|
|
# Enable legacy sysfs gpio export. Will be disabled in future releases
|
||
|
|
|
||
|
|
ENABLESYSFS=${JETHUB_SYSFS_ENABLE:-true}
|
||
|
|
|
||
|
|
GPIOSET=${GPIOSET:-/usr/bin/gpioset}
|
||
|
|
|
||
|
|
### define functions
|
||
|
|
|
||
|
|
configure_gpiobase()
|
||
|
|
{
|
||
|
|
declare -g GPIOBASE
|
||
|
|
declare -g GPIOCHIP
|
||
|
|
declare -g -A GPIOCHIPBASE
|
||
|
|
for gpiochipsys in /sys/class/gpio/gpiochip*/; do
|
||
|
|
gpiochipsys=${gpiochipsys%*/}
|
||
|
|
gpiochiptemp=$(find "${gpiochipsys}"/device/gpiochip* -type d | head -n 1)
|
||
|
|
GPIOCHIP=${gpiochiptemp##*/}
|
||
|
|
GPIOBASE=$(cat "${gpiochipsys}/base")
|
||
|
|
GPIOCHIPBASE["$(echo "${GPIOCHIP}" | tr -d -c 0-9)"]=${GPIOBASE}
|
||
|
|
done
|
||
|
|
if [[ -z "${GPIOBASE}" ]]; then
|
||
|
|
echo Can not find gpiochip and base number
|
||
|
|
exit 1
|
||
|
|
fi
|
||
|
|
}
|
||
|
|
|
||
|
|
gpio_set()
|
||
|
|
{
|
||
|
|
gpiochip="${1}"
|
||
|
|
GPIOL=${2}
|
||
|
|
VALUE=${3}
|
||
|
|
LOW=${4}
|
||
|
|
echo "${0}: GPIOSET: gpiochip=${gpiochip} line=${GPIOL} val=${VALUE} low=${LOW} base=$((GPIOCHIPBASE[${gpiochip}]))"
|
||
|
|
if [[ "${ENABLESYSFS}" == "true" ]]; then
|
||
|
|
GPIOLINE=$((GPIOCHIPBASE[${gpiochip}]+GPIOL))
|
||
|
|
echo "${VALUE}" > /sys/class/gpio/gpio${GPIOLINE}/value
|
||
|
|
else
|
||
|
|
if [ "${LOW}" == "${GPIO_ACTIVE_LOW}" ]; then
|
||
|
|
LOW="-l"
|
||
|
|
else
|
||
|
|
LOW=""
|
||
|
|
fi
|
||
|
|
${GPIOSET} "${LOW}" "${gpiochip}" "${GPIOL}=${VALUE}"
|
||
|
|
fi
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
unexport_sysfs()
|
||
|
|
{
|
||
|
|
for i in /sys/class/gpio/gpio* ; do
|
||
|
|
if ! echo "$i" | grep -q chip ; then
|
||
|
|
ii=$(echo "${i##*/}"| tr -d -c 0-9)
|
||
|
|
echo "$ii" > /sys/class/gpio/unexport
|
||
|
|
fi
|
||
|
|
done
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
configure_gpio() {
|
||
|
|
# Get base
|
||
|
|
GPIOCHIP=${1}
|
||
|
|
GPIOL=${2}
|
||
|
|
GPIOLINE=$((GPIOCHIPBASE[${GPIOCHIP}]+GPIOL))
|
||
|
|
DIRECTION=${3}
|
||
|
|
ACTIVELEVEL=${4}
|
||
|
|
echo "${0}: Export GPIO to sysfs: gpio=${GPIOLINE} (${GPIOL}), direction=${DIRECTION}, active_level=${ACTIVELEVEL}"
|
||
|
|
if [ ! -d /sys/class/gpio/gpio${GPIOLINE} ]; then
|
||
|
|
echo ${GPIOLINE} > /sys/class/gpio/export
|
||
|
|
if [ ! -d /sys/class/gpio/gpio${GPIOLINE} ]; then
|
||
|
|
echo "${0}: *** Error: Failed to configure GPIO ${GPIOLINE}"
|
||
|
|
exit 1
|
||
|
|
fi
|
||
|
|
fi
|
||
|
|
|
||
|
|
if [ "${DIRECTION}" == "${GPIO_DIRECTION_OUTPUT}" ]; then
|
||
|
|
echo "out" > /sys/class/gpio/gpio${GPIOLINE}/direction
|
||
|
|
else
|
||
|
|
echo "in" > /sys/class/gpio/gpio${GPIOLINE}/direction
|
||
|
|
fi
|
||
|
|
|
||
|
|
if [ "${ACTIVELEVEL}" == "${GPIO_ACTIVE_LOW}" ]; then
|
||
|
|
echo 1 > /sys/class/gpio/gpio${GPIOLINE}/active_low
|
||
|
|
fi
|
||
|
|
}
|
||
|
|
|
||
|
|
configure_led() {
|
||
|
|
echo "${0}: Configure: gpiochip=${1} led=${2}, state=${3}, active_level=${4}"
|
||
|
|
gpio_set "${1}" "${2}" "${3}" "${4}"
|
||
|
|
}
|
||
|
|
|
||
|
|
### end define functions
|
||
|
|
|
||
|
|
### begin
|
||
|
|
|
||
|
|
echo "${0}: Unexport gpio from sysfs"
|
||
|
|
unexport_sysfs
|
||
|
|
|
||
|
|
if [[ "${ENABLESYSFS}" = "true" ]]; then
|
||
|
|
echo "${0}: Configure GPIOs as sysfs ..."
|
||
|
|
|
||
|
|
configure_gpiobase
|
||
|
|
|
||
|
|
for gpio_parameters in "${GPIOS[@]}"
|
||
|
|
do
|
||
|
|
# shellcheck disable=SC2086
|
||
|
|
configure_gpio ${gpio_parameters}
|
||
|
|
done
|
||
|
|
else
|
||
|
|
echo "${0}: Configure GPIOs for gpiod"
|
||
|
|
fi
|
||
|
|
|
||
|
|
echo "${0}: Configure LEDs ..."
|
||
|
|
for leds_parameters in "${LEDS[@]}"
|
||
|
|
do
|
||
|
|
# shellcheck disable=SC2086
|
||
|
|
configure_led ${leds_parameters}
|
||
|
|
done
|
||
|
|
|
||
|
|
if [[ -n "${ADDITIONALFUNC}" ]]; then
|
||
|
|
for func in ${ADDITIONALFUNC}; do
|
||
|
|
echo "${0}: Start additional init function ${func}"
|
||
|
|
${func}
|
||
|
|
done
|
||
|
|
fi
|
||
|
|
|
||
|
|
echo "${0}: Initialization done"
|
||
|
|
|
||
|
|
exit 0
|