fp@1740: #!/bin/sh
fp@1740: 
fp@1740: #------------------------------------------------------------------------------
fp@1740: #
fp@1740: #  Init script for EtherCAT
fp@1740: #
fp@1740: #  $Id$
fp@1740: #
fp@1740: #  Copyright (C) 2006  Florian Pose, Ingenieurgemeinschaft IgH
fp@1740: #
fp@1740: #  This file is part of the IgH EtherCAT Master.
fp@1740: #
fp@1740: #  The IgH EtherCAT Master is free software; you can redistribute it
fp@1740: #  and/or modify it under the terms of the GNU General Public License
fp@1740: #  as published by the Free Software Foundation; either version 2 of the
fp@1740: #  License, or (at your option) any later version.
fp@1740: #
fp@1740: #  The IgH EtherCAT Master is distributed in the hope that it will be
fp@1740: #  useful, but WITHOUT ANY WARRANTY; without even the implied warranty of
fp@1740: #  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
fp@1740: #  GNU General Public License for more details.
fp@1740: #
fp@1740: #  You should have received a copy of the GNU General Public License
fp@1740: #  along with the IgH EtherCAT Master; if not, write to the Free Software
fp@1740: #  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
fp@1740: #
fp@1740: #  The right to use EtherCAT Technology is granted and comes free of
fp@1740: #  charge under condition of compatibility of product made by
fp@1740: #  Licensee. People intending to distribute/sell products based on the
fp@1740: #  code, have to sign an agreement to guarantee that products using
fp@1740: #  software based on IgH EtherCAT master stay compatible with the actual
fp@1740: #  EtherCAT specification (which are released themselves as an open
fp@1740: #  standard) as the (only) precondition to have the right to use EtherCAT
fp@1740: #  Technology, IP and trade marks.
fp@1740: #
fp@1740: #------------------------------------------------------------------------------
fp@1740: 
fp@1740: ### BEGIN INIT INFO
fp@1740: # Provides:          ethercat
fp@1740: # Required-Start:    $local_fs $syslog $network
fp@1740: # Should-Start:      $time ntp
fp@1740: # Required-Stop:     $local_fs $syslog $network
fp@1740: # Should-Stop:       $time ntp
fp@1740: # Default-Start:     3 5
fp@1740: # Default-Stop:      0 1 2 6
fp@1740: # Short-Description: IgH EtherCAT master modules
fp@1740: # Description:
fp@1740: ### END INIT INFO
fp@1740: 
fp@1740: #------------------------------------------------------------------------------
fp@1740: 
fp@1744: MODPROBE=/sbin/modprobe
fp@1744: RMMOD=/sbin/rmmod
fp@1744: MODINFO=/sbin/modinfo
fp@1740: 
fp@1740: #------------------------------------------------------------------------------
fp@1740: 
fp@1740: ETHERCAT_CONFIG=/etc/sysconfig/ethercat
fp@1740: 
fp@1744: if [ ! -r ${ETHERCAT_CONFIG} ]; then
fp@1744:     echo ${ETHERCAT_CONFIG} not existing;
fp@1744:     if [ "${1}" = "stop" ]; then
fp@1740: 	exit 0
fp@1740:     else
fp@1740: 	exit 6
fp@1740:     fi
fp@1740: fi
fp@1740: 
fp@1744: . ${ETHERCAT_CONFIG}
fp@1744: 
fp@1744: #------------------------------------------------------------------------------
fp@1744: 
fp@1744: function exit_success()
fp@1744: {
fp@1744:     if [ -r /etc/rc.status ]; then
fp@1744:         rc_reset
fp@1744:         rc_status -v
fp@1744:         rc_exit
fp@1744:     else
fp@1744:         echo " done"
fp@1744:         exit 0
fp@1744:     fi
fp@1744: }
fp@1744: 
fp@1744: #------------------------------------------------------------------------------
fp@1744: 
fp@1744: function exit_running()
fp@1744: {
fp@1744:     if [ -r /etc/rc.status ]; then
fp@1744:         rc_reset
fp@1744:         rc_status -v
fp@1744:         rc_exit
fp@1744:     else
fp@1744:         echo " running"
fp@1744:         exit 0
fp@1744:     fi
fp@1744: }
fp@1744: 
fp@1744: #------------------------------------------------------------------------------
fp@1744: 
fp@1744: function exit_fail()
fp@1744: {
fp@1744:     if [ -r /etc/rc.status ]; then
fp@1744:         rc_failed
fp@1745:         rc_status -v
fp@1744:         rc_exit
fp@1744:     else
fp@1744:         echo " failed"
fp@1744:         exit 1
fp@1744:     fi
fp@1744: }
fp@1744: 
fp@1744: #------------------------------------------------------------------------------
fp@1744: 
fp@1745: function exit_dead()
fp@1745: {
fp@1745:     if [ -r /etc/rc.status ]; then
fp@1745:         rc_failed
fp@1745:         rc_status -v
fp@1745:         rc_exit
fp@1745:     else
fp@1745:         echo " dead"
fp@1745:         exit 1
fp@1745:     fi
fp@1745: }
fp@1745: 
fp@1745: #------------------------------------------------------------------------------
fp@1745: 
fp@1744: function parse_mac_address()
fp@1744: {
fp@1744:     if [ -z "${1}" ]; then
fp@1744:         MAC=""
fp@1744:     elif echo ${1} | grep -qE '^([0-9a-fA-F]{2}:){5}[0-9a-fA-F]{2}$'; then
fp@1744:         MAC=${1}
fp@1744:     else
fp@1744:         echo Invalid MAC address \"${1}\" in ${ETHERCAT_CONFIG}
fp@1744:         exit_fail
fp@1744:     fi 
fp@1744: }
fp@1744: 
fp@1744: #------------------------------------------------------------------------------
fp@1744: 
fp@1744: if [ -r /etc/rc.status ]; then
fp@1744:     . /etc/rc.status
fp@1744:     rc_reset
fp@1744: fi
fp@1744: 
fp@1744: case "${1}" in
fp@1744: 
fp@1744: start)
fp@1744:     echo -n "Starting EtherCAT master "
fp@1744: 
fp@1744:     # construct DEVICES and BACKUPS from configuration variables
fp@1744:     DEVICES=""
fp@1744:     BACKUPS=""
fp@1744:     MASTER_INDEX=0
fp@1744:     while true; do
fp@1744:         DEVICE=$(eval echo "\${MASTER${MASTER_INDEX}_DEVICE}")
fp@1744:         BACKUP=$(eval echo "\${MASTER${MASTER_INDEX}_BACKUP}")
fp@1744:         if [ -z "${DEVICE}" ]; then break; fi
fp@1744: 
fp@1744:         if [ ${MASTER_INDEX} -gt 0 ]; then
fp@1744:             DEVICES=${DEVICES},
fp@1744:             BACKUPS=${BACKUPS},
fp@1744:         fi
fp@1744: 
fp@1744:         parse_mac_address ${DEVICE}
fp@1744:         DEVICES=${DEVICES}${MAC}
fp@1744:         
fp@1744:         parse_mac_address ${BACKUP}
fp@1744:         BACKUPS=${BACKUPS}${MAC}
fp@1744: 
fp@1744:         MASTER_INDEX=$(expr ${MASTER_INDEX} + 1)
fp@1744:     done
fp@1744: 
fp@1744:     # load master module
fp@1744:     if ! ${MODPROBE} ec_master main=${DEVICES} backup=${BACKUPS}; then
fp@1744:         exit_fail
fp@1744:     fi
fp@1744: 
fp@1744:     # check for modules to replace
fp@1744:     for MODULE in ${DEVICE_MODULES}; do
fp@1744:         ECMODULE=ec_${MODULE}
fp@1744:         if ! ${MODINFO} ${ECMODULE} > /dev/null; then
fp@1744:             continue # ec_* module not found
fp@1744:         fi
fp@1744:         if lsmod | grep "^${MODULE} " > /dev/null; then
fp@1744:             if ! ${RMMOD} ${MODULE}; then
fp@1744:                 exit_fail
fp@1744:             fi
fp@1744:         fi
fp@1744:         if ! ${MODPROBE} ${ECMODULE}; then
fp@1744:             ${MODPROBE} ${MODULE} # try to restore module
fp@1744:             exit_fail
fp@1744:         fi
fp@1744:     done
fp@1744: 
fp@1744:     exit_success
fp@1744:     ;;
fp@1744: 
fp@1744: stop)
fp@1744:     echo -n "Shutting down EtherCAT master "
fp@1744: 
fp@1744:     # unload EtherCAT device modules
fp@1744:     for MODULE in ${DEVICE_MODULES} master; do
fp@1744:         ECMODULE=ec_${MODULE}
fp@1744:         if ! lsmod | grep -q "^${ECMODULE} "; then
fp@1744:             continue # ec_* module not loaded
fp@1744:         fi
fp@1744:         if ! ${RMMOD} ${ECMODULE}; then
fp@1744:             exit_fail
fp@1744:         fi;
fp@1744:     done
fp@1744: 
fp@1744:     sleep 1
fp@1744: 
fp@1744:     # reload previous modules
fp@1744:     for MODULE in ${DEVICE_MODULES}; do
fp@1744:         if ! ${MODPROBE} ${MODULE}; then
fp@1744:             echo Warning: Failed to restore ${MODULE}.
fp@1744:         fi
fp@1744:     done
fp@1744: 
fp@1744:     exit_success
fp@1744:     ;;
fp@1744: 
fp@1744: restart)
fp@1744:     $0 stop || exit 1
fp@1744:     sleep 1
fp@1744:     $0 start
fp@1744:     ;;
fp@1744: 
fp@1744: status)
fp@1744:     echo -n "Checking for EtherCAT "
fp@1744: 
fp@1744:     lsmod | grep -q "^ec_master "
fp@1744:     MASTERS_RUNNING=$?
fp@1744: 
fp@1744:     ! grep -q "(WAITING)" /sys/ethercat/master*/info
fp@1744:     MASTERS_IDLE=$?
fp@1744: 
fp@1744:     # master module loaded and masters not waiting for devices?
fp@1744:     if [ ${MASTERS_RUNNING} -eq 0 -a ${MASTERS_IDLE} -eq 0 ]; then
fp@1744:         exit_running
fp@1744:     else
fp@1745:         exit_dead
fp@1744:     fi
fp@1744:     ;;
fp@1744: 
fp@1744: *)
fp@1744:     echo "USAGE: $0 {start|stop|restart|status}"
fp@1744:     ;;
fp@1740: 
fp@1740: esac
fp@1740: 
fp@1744: if [ -r /etc/rc.status ]; then
fp@1744:     rc_exit
fp@1744: else
fp@1744:     exit 1
fp@1744: fi
fp@1744: 
fp@1744: #------------------------------------------------------------------------------