base-files/leds: add setting the LED color via uci
[openwrt/staging/robimarko.git] / package / base-files / files / etc / init.d / led
index 7c2a185013d2aa52db1ef8baaccf6053e5633fdd..ea2688cab29efaf74ad8ed0c08f6e571511fb19b 100755 (executable)
@@ -3,6 +3,39 @@
 
 START=96
 
+led_color_set() {
+       local cfg="$1"
+       local sysfs="$2"
+
+       local max_b
+       local colors
+       local color
+       local multi_intensity
+       local value
+       local write
+
+       [ -e /sys/class/leds/${sysfs}/multi_intensity ] || return
+       [ -e /sys/class/leds/${sysfs}/multi_index ] || return
+
+       max_b="$(cat /sys/class/leds/${sysfs}/max_brightness)"
+       colors="$(cat /sys/class/leds/${sysfs}/multi_index | tr " " "\n")"
+       multi_intensity=""
+       for color in $colors; do
+               config_get value $1 "color_${color}" "0"
+               [ "$value" -gt 0 ] && write=1
+               [ "$value" -gt "$max_b" ] && value="$max_b"
+               multi_intensity="${multi_intensity}${value} "
+       done
+
+       # Check if any color is configured
+       [ "$write" = 1 ] || return
+       # Remove last whitespace
+       multi_intensity="${multi_intensity:0:-1}"
+
+       echo "setting '${name}' led color to '${multi_intensity}'"
+       echo "${multi_intensity}" > /sys/class/leds/${sysfs}/multi_intensity
+}
+
 load_led() {
        local name
        local sysfs
@@ -20,8 +53,8 @@ load_led() {
        config_get trigger $1 trigger "none"
        config_get dev $1 dev
        config_get ports $1 port
-       config_get mode $1 mode "link"
-       config_get_bool default $1 default "nil"
+       config_get mode $1 mode
+       config_get_bool default $1 default "0"
        config_get delayon $1 delayon
        config_get delayoff $1 delayoff
        config_get interval $1 interval "50"
@@ -29,12 +62,13 @@ load_led() {
        config_get delay $1 delay "150"
        config_get message $1 message ""
        config_get gpio $1 gpio "0"
-       config_get inverted $1 inverted "0"
+       config_get_bool inverted $1 inverted "0"
 
-       if [ "$trigger" = "rssi" ]; then
-               # handled by rssileds userspace process
-               return
-       fi
+       # execute application led trigger
+       [ -f "/usr/libexec/led-trigger/${trigger}" ] && {
+               . "/usr/libexec/led-trigger/${trigger}"
+               return 0
+       }
 
        [ "$trigger" = "usbdev" ] && {
                # Backward compatibility: translate to the new trigger
@@ -48,30 +82,46 @@ load_led() {
        [ -e /sys/class/leds/${sysfs}/brightness ] && {
                echo "setting up led ${name}"
 
-               printf "%s %s %d\n" \
+               printf "%s %s %d" \
                        "$sysfs" \
                        "$(sed -ne 's/^.*\[\(.*\)\].*$/\1/p' /sys/class/leds/${sysfs}/trigger)" \
                        "$(cat /sys/class/leds/${sysfs}/brightness)" \
                                >> /var/run/led.state
+               # Save default color if supported
+               [ -e /sys/class/leds/${sysfs}/multi_intensity ] && {
+                       printf " %s" \
+                               "$(sed 's/\ /:/g' /sys/class/leds/${sysfs}/multi_intensity)" \
+                               >> /var/run/led.state
+               }
+               printf "\n" >> /var/run/led.state
 
                [ "$default" = 0 ] &&
                        echo 0 >/sys/class/leds/${sysfs}/brightness
 
-               echo $trigger > /sys/class/leds/${sysfs}/trigger 2> /dev/null
-               ret="$?"
-
                [ $default = 1 ] &&
                        cat /sys/class/leds/${sysfs}/max_brightness > /sys/class/leds/${sysfs}/brightness
 
+               led_color_set "$1" "$sysfs"
+
+               echo $trigger > /sys/class/leds/${sysfs}/trigger 2> /dev/null
+               ret="$?"
                [ $ret = 0 ] || {
                        echo >&2 "Skipping trigger '$trigger' for led '$name' due to missing kernel module"
                        return 1
                }
                case "$trigger" in
+               "heartbeat")
+                       echo "${inverted}" > "/sys/class/leds/${sysfs}/invert"
+                       ;;
+
                "netdev")
                        [ -n "$dev" ] && {
                                echo $dev > /sys/class/leds/${sysfs}/device_name
-                               echo $mode > /sys/class/leds/${sysfs}/mode
+                               for m in $mode; do
+                                       [ -e "/sys/class/leds/${sysfs}/$m" ] && \
+                                               echo 1 > /sys/class/leds/${sysfs}/$m
+                               done
+                               echo $interval > /sys/class/leds/${sysfs}/interval
                        }
                        ;;
 
@@ -109,6 +159,8 @@ load_led() {
                        config_get speed_mask $1 speed_mask
                        [ -n "$speed_mask" ] && \
                                echo $speed_mask > /sys/class/leds/${sysfs}/speed_mask
+                       [ -n "$mode" ] && \
+                               echo "$mode" > /sys/class/leds/${sysfs}/mode
                        ;;
                esac
        }
@@ -117,13 +169,17 @@ load_led() {
 start() {
        [ -e /sys/class/leds/ ] && {
                [ -s /var/run/led.state ] && {
-                       local led trigger brightness
-                       while read led trigger brightness; do
+                       local led trigger brightness color
+                       while read led trigger brightness color; do
                                [ -e "/sys/class/leds/$led/trigger" ] && \
                                        echo "$trigger" > "/sys/class/leds/$led/trigger"
 
                                [ -e "/sys/class/leds/$led/brightness" ] && \
                                        echo "$brightness" > "/sys/class/leds/$led/brightness"
+
+                               [ -e "/sys/class/leds/$led/multi_intensity" ] && \
+                                       echo "$color" | sed 's/:/\ /g' > \
+                                               "/sys/class/leds/$led/multi_intensity"
                        done < /var/run/led.state
                        rm /var/run/led.state
                }