1

#!/bin/sh

     2

     3

#------------------------------------------------------------------------------

     4

#

     5

#  Init script for EtherCAT

     6

#

     7

#  $Id$

     8

#

     9

#  Copyright (C) 2006  Florian Pose, Ingenieurgemeinschaft IgH

    10

#

    11

#  This file is part of the IgH EtherCAT Master.

    12

#

    13

#  The IgH EtherCAT Master is free software; you can redistribute it

    14

#  and/or modify it under the terms of the GNU General Public License

    15

#  as published by the Free Software Foundation; either version 2 of the

    16

#  License, or (at your option) any later version.

    17

#

    18

#  The IgH EtherCAT Master is distributed in the hope that it will be

    19

#  useful, but WITHOUT ANY WARRANTY; without even the implied warranty of

    20

#  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

    21

#  GNU General Public License for more details.

    22

#

    23

#  You should have received a copy of the GNU General Public License

    24

#  along with the IgH EtherCAT Master; if not, write to the Free Software

    25

#  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA

    26

#

    27

#  The right to use EtherCAT Technology is granted and comes free of

    28

#  charge under condition of compatibility of product made by

    29

#  Licensee. People intending to distribute/sell products based on the

    30

#  code, have to sign an agreement to guarantee that products using

    31

#  software based on IgH EtherCAT master stay compatible with the actual

    32

#  EtherCAT specification (which are released themselves as an open

    33

#  standard) as the (only) precondition to have the right to use EtherCAT

    34

#  Technology, IP and trade marks.

    35

#

    36

#------------------------------------------------------------------------------

    37

    38

### BEGIN INIT INFO

    39

# Provides:          ethercat

    40

# Required-Start:    $local_fs $syslog $network

    41

# Should-Start:      $time ntp

    42

# Required-Stop:     $local_fs $syslog $network

    43

# Should-Stop:       $time ntp

    44

# Default-Start:     3 5

    45

# Default-Stop:      0 1 2 6

    46

# Short-Description: IgH EtherCAT master modules

    47

# Description:

    48

### END INIT INFO

    49

    50

#------------------------------------------------------------------------------

    51

    52

XMLDEVICE='ecxml'

    56

    57

#------------------------------------------------------------------------------

    58

    59

ETHERCAT_CONFIG=/etc/sysconfig/ethercat

    60

    61

if [ ! -r ${ETHERCAT_CONFIG} ]; then

    62

    echo ${ETHERCAT_CONFIG} not existing;

    63

    if [ "${1}" = "stop" ]; then

    64

	exit 0

    65

    else

    66

	exit 6

    67

    fi

    68

fi

    69

    70

. ${ETHERCAT_CONFIG}

    71

    72

#------------------------------------------------------------------------------

    73

   115

function parse_mac_address()

   116

{

   117

    if [ -z "${1}" ]; then

   118

        MAC=""

   119

    elif echo ${1} | grep -qE '^([0-9a-fA-F]{2}:){5}[0-9a-fA-F]{2}$'; then

   120

        MAC=${1}

   121

    else

   122

        echo Invalid MAC address \"${1}\" in ${ETHERCAT_CONFIG}

   124

    fi 

   125

}

   126

   127

#------------------------------------------------------------------------------

   128

   133

   134

case "${1}" in

   135

   136

start)

   137

    echo -n "Starting EtherCAT master "

   138

   139

    # construct DEVICES and BACKUPS from configuration variables

   140

    DEVICES=""

   141

    BACKUPS=""

   142

    MASTER_INDEX=0

   143

    while true; do

   144

        DEVICE=$(eval echo "\${MASTER${MASTER_INDEX}_DEVICE}")

   145

        BACKUP=$(eval echo "\${MASTER${MASTER_INDEX}_BACKUP}")

   146

        if [ -z "${DEVICE}" ]; then break; fi

   147

   148

        if [ ${MASTER_INDEX} -gt 0 ]; then

   149

            DEVICES=${DEVICES},

   150

            BACKUPS=${BACKUPS},

   151

        fi

   152

   153

        parse_mac_address ${DEVICE}

   154

        DEVICES=${DEVICES}${MAC}

   155

   156

        parse_mac_address ${BACKUP}

   157

        BACKUPS=${BACKUPS}${MAC}

   158

   159

        MASTER_INDEX=$(expr ${MASTER_INDEX} + 1)

   160

    done

   161

   162

    # load master module

   165

    fi

   166

   167

    # remove stale device node

   168

    rm -f /dev/${XMLDEVICE}0

   169

   170

    # get dynamic major number

   171

    MAJOR=$(awk "\$2==\"EtherCAT\" {print \$1}" /proc/devices)

   172

   173

    # create character device

   174

    mknod /dev/${XMLDEVICE}0 c ${MAJOR} 0

   175

   176

    # check for modules to replace

   177

    for MODULE in ${DEVICE_MODULES}; do

   178

        ECMODULE=ec_${MODULE}

   181

        fi

   182

        if lsmod | grep "^${MODULE} " > /dev/null; then

   185

            fi

   186

        fi

   194

    ;;

   195

   196

stop)

   197

    echo -n "Shutting down EtherCAT master "

   198

   199

    # unload EtherCAT device modules

   200

    for MODULE in ${DEVICE_MODULES} master; do

   201

        ECMODULE=ec_${MODULE}

   202

        if ! lsmod | grep -q "^${ECMODULE} "; then

   207

        fi;

   208

    done

   209

   210

    # remove device node

   211

    rm -f /dev/${XMLDEVICE}0

   212

   213

    sleep 1

   214

   215

    # reload previous modules

   216

    for MODULE in ${DEVICE_MODULES}; do

   218

            echo Warning: Failed to restore ${MODULE}.

   219

        fi

   220

    done

   221

   223

    ;;

   224

   225

restart)

   226

    $0 stop || exit 1

   227

    sleep 1

   228

    $0 start

   229

    ;;

   230

   231

status)

   232

    echo -n "Checking for EtherCAT "

   233

   234

    lsmod | grep -q "^ec_master "

   235

    MASTERS_RUNNING=$?

   236

   237

    ! grep -q "(WAITING)" /sys/ethercat/master*/info

   238

    MASTERS_IDLE=$?

   239

   240

    # master module loaded and masters not waiting for devices?

   246

    ;;

   247

   248

*)

   249

    echo "USAGE: $0 {start|stop|restart|status}"

   250

    ;;

   251

   252

esac

   253