sonic-buildimage/device/delta/x86_64-delta_agc032-r0/fancontrol.service

#!/bin/bash
#
# Simple script implementing a temperature dependent fan speed control
# Supported Linux kernel versions: 2.6.5 and later
#
# Version 0.70
#
# Usage: fancontrol [CONFIGFILE]
#
# Dependencies:
#   bash, egrep, sed, cut, sleep, readlink, lm_sensors :)
#
# Please send any questions, comments or success stories to
# marius.reiner@hdev.de
# Thanks!
#
# For configuration instructions and warnings please see fancontrol.txt, which
# can be found in the doc/ directory or at the website mentioned above.
#
#
#    Copyright 2003 Marius Reiner <marius.reiner@hdev.de>
#    Copyright (C) 2007-2009 Jean Delvare <khali@linux-fr.org>
#
#    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., 51 Franklin Street, Fifth Floor, Boston,
#    MA 02110-1301 USA.
#
#

PIDFILE="/var/run/fancontrol.pid"

#DEBUG=1
MAX=255

function LoadConfig
{
    local fcvcount fcv

    echo "Loading configuration from $1 ..."
    if [ ! -r "$1" ]
    then
        echo "Error: Can't read configuration file" >&2
        exit 1
    fi

    # grep configuration from file
    INTERVAL=`egrep '^INTERVAL=.*$' $1 | sed -e 's/INTERVAL=//g'`
    DEVPATH=`egrep '^DEVPATH=.*$' $1 | sed -e 's/DEVPATH= *//g'`
    DEVNAME=`egrep '^DEVNAME=.*$' $1 | sed -e 's/DEVNAME= *//g'`
    FCTEMPS=`egrep '^FCTEMPS=.*$' $1 | sed -e 's/FCTEMPS=//g'`
    MINTEMP=`egrep '^MINTEMP=.*$' $1 | sed -e 's/MINTEMP=//g'`
    MAXTEMP=`egrep '^MAXTEMP=.*$' $1 | sed -e 's/MAXTEMP=//g'`
    MINSTART=`egrep '^MINSTART=.*$' $1 | sed -e 's/MINSTART=//g'`
    MINSTOP=`egrep '^MINSTOP=.*$' $1 | sed -e 's/MINSTOP=//g'`
    HWMON=$( echo "$DEVPATH" | sed 's/=.*$//g')
    FCDEVPATH=$( echo "$DEVPATH" | sed 's/^.*=//g')
    FCMINTEMP=$MINTEMP
    FCMAXTEMP=$MAXTEMP
    FCMINSTART=$MINSTART
    FCMINSTOP=$MINSTOP
    AFCTEMP_1_LOWER=(00 39 36 41 46 55)
    AFCTEMP_1_UPPER=(39 39 44 49 54 150)
    AFCTEMP_2_LOWER=(00 61 65 69 73 82)
    AFCTEMP_2_UPPER=(63 67 71 75 79 150)
    AFCTEMP_3_LOWER=(00 51 55 59 63 71)
    AFCTEMP_3_UPPER=(53 57 61 65 69 150)
    AFCTEMP_4_LOWER=(00 46 50 54 58 65)
    AFCTEMP_4_UPPER=(45 52 56 60 64 150)
    AFCTEMP_5_LOWER=(00 46 50 54 58 65)
    AFCTEMP_5_UPPER=(45 52 56 60 64 150)


    FCFANS=`egrep '^FCFANS=.*$' $1 | sed -e 's/FCFANS=//g'`

    # Check whether all mandatory settings are set
    if [[ -z ${INTERVAL} || -z ${FCTEMPS} || -z ${MINTEMP} || -z ${MAXTEMP} || -z ${MINSTART} || -z ${MINSTOP} ]]
    then
        echo "Some mandatory settings missing, please check your config file!" >&2
        exit 1
    fi
    if [ "$INTERVAL" -le 0 ]
    then
        echo "Error in configuration file:" >&2
        echo "INTERVAL must be at least 1" >&2
        exit 1
    fi

    # write settings to arrays for easier use and print them
    echo
    echo "Common settings:"
    
    temp_string=$FCTEMPS
    
    let fcvcount=0
    for fcv in $FCTEMPS
    do
        fcvcount=$((fcvcount+1))
        AFCTEMP[$fcvcount]=$( echo "$temp_string" | cut -d" " -f $fcvcount )
        AFCTEMP[$fcvcount]=$( echo "${AFCTEMP[$fcvcount]}" | sed 's/hwmon1/\/sys\/bus\/i2c\/devices/g' )
        AFCTEMP_PATH[$fcvcount]=$( echo "${AFCTEMP[$fcvcount]}" | sed 's/hwmon1/\/sys\/bus\/i2c\/devices/g' )
        AFCTEMP[$fcvcount]=$( cat ${AFCTEMP[$fcvcount]} )
        AFCTEMP[$fcvcount]=$(( AFCTEMP[$fcvcount]/1000 ))
    done

    fan_string=$FCFANS
    fcvcount=0
    zero=0
    for fcv in $FCFANS
    do
        fcvcount=$((fcvcount+1))
        AFCFAN[$fcvcount]=$( echo "$fan_string" | cut -d" " -f $fcvcount )
        AFCFAN_PATH[$fcvcount]=$( echo "${AFCFAN[$fcvcount]}" | sed 's/hwmon1/\/sys\/bus\/i2c\/devices/g' )
        AFCFAN_TARGET[$fcvcount]=$( echo "${AFCFAN_PATH[$fcvcount]}" | sed 's/hwmon1/\/sys\/bus\/i2c\/devices/g' )
        AFCFAN_TARGET[$fcvcount]=$( echo "${AFCFAN_TARGET[$fcvcount]}"  | sed 's/$/_percentage/g')
        AFCFAN[$fcvcount]=$( cat ${AFCFAN_PATH[$fcvcount]} )
        if [ "${AFCFAN[$fcvcount]}" == 960 ]
        then
            AFCFAN[$fcvcount]=$zero
        fi
    done
}

# Check that all referenced sysfs files exist
function CheckFiles
{
    local outdated=0 fcvcount tsen fan
    if [ $outdated -eq 1 ]
    then
        echo >&2
        echo "At least one referenced file is missing. Either some required kernel" >&2
        echo "modules haven't been loaded, or your configuration file is outdated." >&2
        echo "In the latter case, you should run pwmconfig again." >&2
    fi
    return $outdated
}

#LoadConfig $1
if [ -f "$1" ]
then
    LoadConfig $1
else
    LoadConfig /etc/fancontrol
fi

# Detect path to sensors
if [ ! -d $DIR ]
then
    echo $0: 'No sensors found! (did you load the necessary modules?)' >&2
    exit 1
fi
cd $DIR

# Check for configuration change
if [ "$DIR" != "/" ] && [ -z "$DEVPATH" -o -z "$DEVNAME" ]
then
    echo "Configuration is too old, please run pwmconfig again" >&2
    exit 1
fi
if [ "$DIR" = "/" -a -n "$DEVPATH" ]
then
    echo "Unneeded DEVPATH with absolute device paths" >&2
    exit 1
fi
CheckFiles || exit 1

if [ -f "$PIDFILE" ]
then
    echo "File $PIDFILE exists, is fancontrol already running?" >&2
    exit 1
fi
echo $$ > "$PIDFILE"

# main function
function UpdateThermalSensors
{
    fcvcount=0
    for fcv in $FCTEMPS
    do
        fcvcount=$((fcvcount+1))
        AFCTEMP[$fcvcount]=$( cat ${AFCTEMP_PATH[$fcvcount]} )
        AFCTEMP[$fcvcount]=$(( AFCTEMP[$fcvcount]/1000 ))
    done
}

function UpdateThermalLevel
{
    AFCTEMP_NUM=$((6-${AFCTEMP_LEVEL[$i]}))
    AFCTEMP_UPPER_BUF=AFCTEMP_"$i"_UPPER["$AFCTEMP_NUM"]
    AFCTEMP_LOWER_BUF=AFCTEMP_"$i"_LOWER["$AFCTEMP_NUM"]

    AFCTEMP_UPPER=${!AFCTEMP_UPPER_BUF}
    AFCTEMP_LOWER=${!AFCTEMP_LOWER_BUF}


    if (( ("${AFCTEMP[$i]}" <= "$AFCTEMP_UPPER") && ("${AFCTEMP[$i]}" >= "$AFCTEMP_LOWER") )) ; then 
        FLAG=2
    elif (( "${AFCTEMP[$i]}" > "$AFCTEMP_UPPER" )); then 
        AFCTEMP_LEVEL[$i]=$((${AFCTEMP_LEVEL[$i]} - 1))
        FLAG=1
    elif (( "${AFCTEMP[$i]}" < "$AFCTEMP_LOWER" )); then     
        AFCTEMP_LEVEL[$i]=$((${AFCTEMP_LEVEL[$i]} + 1))
        FLAG=1
    else
        AFCTEMP_LEVEL[$i]=1
        FLAG=2
    fi
}

function UpdateFanSpeeds
{
    #echo "num tmp lev  F   L   H"
    #Update level
    for i in 1 2 3 4 5
    do
        #echo "----------------------"
        FLAG=0
        #FLAG=0 : initial flag
        #FLAG=1 : update level
        #FLAG=2 : final level
        while [ $FLAG -ne 2 ]
        do
            UpdateThermalLevel
            #echo " $i  ${AFCTEMP[$i]}   ${AFCTEMP_LEVEL[$i]}   $FLAG  $AFCTEMP_LOWER  $AFCTEMP_UPPER "
        done
    done

    min=${AFCTEMP_LEVEL[0]}
    for j in "${AFCTEMP_LEVEL[@]}"; do
      (( j < min )) && min=$j
    done

    if (($min == 1 || $min == 2)); then 
        FAN_PERCENTAGE=100
    elif (($min == 3)); then 
        FAN_PERCENTAGE=80
    elif (($min == 4)); then
        FAN_PERCENTAGE=60
    elif (($min == 5)); then
        FAN_PERCENTAGE=50
    elif (($min == 6)); then
        FAN_PERCENTAGE=40
    else
        FAN_PERCENTAGE=100
    fi
    echo "The lowest level of thermal sensors: $min "
    echo "Trying to set fan speed to $FAN_PERCENTAGE %"
    #Set speed to fan1~fan10
    let fcvcount=0
    for fcv in $FCFANS
    do
        fcvcount=$(( fcvcount + 1 ))
        echo  $FAN_PERCENTAGE > ${AFCFAN_TARGET[$fcvcount]} 
        AFCFAN[$fcvcount]=$( cat ${AFCFAN_PATH[$fcvcount]} )

        if [ "${AFCFAN[$fcvcount]}" == 960 ]
        then
            AFCFAN[$fcvcount]=$zero
        fi
        echo "FAN fan$fcvcount = ${AFCFAN[$fcvcount]} (rpm)"
    done

    FAN_ON_PSU_PERCENTAGE=$FAN_PERCENTAGE
    #Set speed to PSU_FAN1
    echo "$FAN_ON_PSU_PERCENTAGE" > '/sys/bus/i2c/devices/1-0058/fan1_set_percentage'
    echo "PSU fan1 =$( cat '/sys/bus/i2c/devices/1-0058/fan1_input' ) (rpm)"
    #Set speed to PSU_FAN2
    echo "$FAN_ON_PSU_PERCENTAGE" > '/sys/bus/i2c/devices/2-0058/fan1_set_percentage'
    echo "PSU fan2 =$( cat '/sys/bus/i2c/devices/2-0058/fan1_input' ) (rpm)"

    rm -f "$PIDFILE"
}

# main loop calling the main function at specified intervals
AFCTEMP_LEVEL=(9 4 4 4 4 4) #inttial level
while true
do
    UpdateThermalSensors
    UpdateFanSpeeds
    echo "Sleep $INTERVAL seconds ..."
    echo
    # Sleep while still handling signals
    sleep $INTERVAL &
    wait $!
done