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'

    53

    54

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

    55

    56

ETHERCAT_CONFIG=/etc/sysconfig/ethercat

    57

    58

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

    59

    echo ${ETHERCAT_CONFIG} not existing;

    60

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

    61

	exit 0

    62

    else

    63

	exit 6

    64

    fi

    65

fi

    66

    67

. ${ETHERCAT_CONFIG}

    68

    69

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

    70

    71

function parse_mac_address()

    72

{

    73

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

    74

        MAC=""

    75

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

    76

        MAC=${1}

    77

    else

    78

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

    79

        /bin/false

    80

        rc_status -v

    81

        rc_exit

    82

    fi 

    83

}

    84

    85

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

    86

    87

. /etc/rc.status

    88

rc_reset

    89

    90

case "${1}" in

    91

    92

start)

    93

    echo -n "Starting EtherCAT master "

    94

    95

    # construct DEVICES and BACKUPS from configuration variables

    96

    DEVICES=""

    97

    BACKUPS=""

    98

    MASTER_INDEX=0

    99

    while true; do

   100

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

   101

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

   102

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

   103

   104

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

   105

            DEVICES=${DEVICES},

   106

            BACKUPS=${BACKUPS},

   107

        fi

   108

   109

        parse_mac_address ${DEVICE}

   110

        DEVICES=${DEVICES}${MAC}

   111

   112

        parse_mac_address ${BACKUP}

   113

        BACKUPS=${BACKUPS}${MAC}

   114

   115

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

   116

    done

   117

   118

    # load master module

   119

    if ! modprobe ec_master main=${DEVICES} backup=${BACKUPS}; then

   120

        modprobe 8139too

   121

        /bin/false

   122

        rc_status -v

   123

        rc_exit

   124

    fi

   125

   126

    # remove stale device node

   127

    rm -f /dev/${XMLDEVICE}0

   128

   129

    # get dynamic major number

   130

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

   131

   132

    # create character device

   133

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

   134

   135

    # check for modules to replace

   136

    for MODULE in ${DEVICE_MODULES}; do

   137

        ECMODULE=ec_${MODULE}

   138

        if ! modinfo ${ECMODULE} > /dev/null; then

   139

            continue

   140

        fi

   141

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

   142

            if ! rmmod ${MODULE}; then

   143

                /bin/false

   144

                rc_status -v

   145

                rc_exit

   146

            fi

   147

        fi

   148

        if ! modprobe ${ECMODULE}; then

   149

            modprobe ${MODULE} # try to restore module

   150

            /bin/false

   151

            rc_status -v

   152

            rc_exit

   153

        fi

   154

    done

   155

   156

    rc_status -v

   157

    ;;

   158

   159

stop)

   160

    echo -n "Shutting down EtherCAT master "

   161

   162

    # unload EtherCAT device modules

   163

    for MODULE in ${DEVICE_MODULES} master; do

   164

        ECMODULE=ec_${MODULE}

   165

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

   166

            continue

   167

        fi

   168

        if ! rmmod ${ECMODULE}; then

   169

            /bin/false

   170

            rc_status -v

   171

            rc_exit

   172

        fi;

   173

    done

   174

   175

    # remove device node

   176

    rm -f /dev/${XMLDEVICE}0

   177

   178

    sleep 1

   179

   180

    # reload previous modules

   181

    for MODULE in ${DEVICE_MODULES}; do

   182

        if ! modprobe ${MODULE}; then

   183

            echo Warning: Failed to restore ${MODULE}.

   184

        fi

   185

    done

   186

   187

    rc_status -v

   188

    ;;

   189

   190

restart)

   191

    $0 stop || exit 1

   192

    sleep 1

   193

    $0 start

   194

    rc_status

   195

    ;;

   196

   197

status)

   198

    echo -n "Checking for EtherCAT "

   199

   200

    lsmod | grep -q "^ec_master "

   201

    MASTERS_RUNNING=$?

   202

   203

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

   204

    MASTERS_IDLE=$?

   205

   206

    # master module loaded and masters not waiting for devices?

   207

    test ${MASTERS_RUNNING} -eq 0 -a ${MASTERS_IDLE} -eq 0

   208

   209

    rc_status -v

   210

    ;;

   211

   212

*)

   213

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

   214

    ;;

   215

   216

esac

   217

   218

rc_exit

   219

   220

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