1

#!/bin/sh

     2

     3

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

     4

#

     5

#  Init script for EtherCAT

     6

#

     7

#  $Id$

     8

#

     9

#  Copyright (C) 2006-2008  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 and/or

    14

#  modify it under the terms of the GNU General Public License version 2, as

    15

#  published by the Free Software Foundation.

    16

#

    17

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

    18

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

    19

#  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General

    20

#  Public License for more details.

    21

#

    22

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

    23

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

    24

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

    25

#

    26

#  Using the EtherCAT technology and brand is permitted in compliance with the

    27

#  industrial property and similar rights of Beckhoff Automation GmbH.

    28

#

    29

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

    30

    31

### BEGIN INIT INFO

    32

# Provides:          ethercat

    33

# Required-Start:    $local_fs $syslog $network

    34

# Should-Start:      $time ntp

    35

# Required-Stop:     $local_fs $syslog $network

    36

# Should-Stop:       $time ntp

    37

# Default-Start:     3 5

    38

# Default-Stop:      0 1 2 6

    39

# Short-Description: EtherCAT master

    40

# Description:       EtherCAT master @VERSION@

    41

### END INIT INFO

    42

    43

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

    44

    45

MODPROBE=/sbin/modprobe

    46

RMMOD=/sbin/rmmod

    47

MODINFO=/sbin/modinfo

    48

ETHERCAT=@prefix@/bin/ethercat

    49

    50

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

    51

    52

ETHERCAT_CONFIG=/etc/sysconfig/ethercat

    53

    54

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

    55

    echo ${ETHERCAT_CONFIG} not existing;

    56

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

    57

	exit 0

    58

    else

    59

	exit 6

    60

    fi

    61

fi

    62

    63

. ${ETHERCAT_CONFIG}

    64

    65

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

    66

    67

exit_success() {

    68

    if [ -r /etc/rc.status ]; then

    69

        rc_reset

    70

        rc_status -v

    71

        rc_exit

    72

    else

    73

        echo " done"

    74

        exit 0

    75

    fi

    76

}

    77

    78

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

    79

    80

exit_fail() {

    81

    if [ -r /etc/rc.status ]; then

    82

        rc_failed

    83

        rc_status -v

    84

        rc_exit

    85

    else

    86

        echo " failed"

    87

        exit 1

    88

    fi

    89

}

    90

    91

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

    92

    93

print_running() {

    94

    if [ -r /etc/rc.status ]; then

    95

        rc_reset

    96

        rc_status -v

    97

    else

    98

        echo " running"

    99

    fi

   100

}

   101

   102

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

   103

   104

print_dead() {

   105

    if [ -r /etc/rc.status ]; then

   106

        rc_failed

   107

        rc_status -v

   108

    else

   109

        echo " dead"

   110

    fi

   111

}

   112

   113

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

   114

   115

parse_mac_address() {

   116

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

   117

        MAC=""

   118

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

   119

        MAC=${1}

   120

    else

   121

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

   122

        exit_fail

   123

    fi 

   124

}

   125

   126

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

   127

   128

if [ -r /etc/rc.status ]; then

   129

    . /etc/rc.status

   130

    rc_reset

   131

fi

   132

   133

case "${1}" in

   134

   135

start)

   136

    echo -n "Starting EtherCAT master @VERSION@ "

   137

   138

    # construct DEVICES and BACKUPS from configuration variables

   139

    DEVICES=""

   140

    BACKUPS=""

   141

    MASTER_INDEX=0

   142

    while true; do

   143

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

   144

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

   145

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

   146

   147

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

   148

            DEVICES=${DEVICES},

   149

            BACKUPS=${BACKUPS},

   150

        fi

   151

   152

        parse_mac_address ${DEVICE}

   153

        DEVICES=${DEVICES}${MAC}

   154

   155

        parse_mac_address ${BACKUP}

   156

        BACKUPS=${BACKUPS}${MAC}

   157

   158

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

   159

    done

   160

   161

    # load master module

   162

    if ! ${MODPROBE} ${MODPROBE_FLAGS} ec_master \

   163

            main_devices=${DEVICES} backup_devices=${BACKUPS}; then

   164

        exit_fail

   165

    fi

   166

   167

    # check for modules to replace

   168

    for MODULE in ${DEVICE_MODULES}; do

   169

        ECMODULE=ec_${MODULE}

   170

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

   171

            continue # ec_* module not found

   172

        fi

   173

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

   174

            if ! ${RMMOD} ${MODULE}; then

   175

                exit_fail

   176

            fi

   177

        fi

   178

        if ! ${MODPROBE} ${MODPROBE_FLAGS} ${ECMODULE}; then

   179

            ${MODPROBE} ${MODPROBE_FLAGS} ${MODULE} # try to restore module

   180

            exit_fail

   181

        fi

   182

    done

   183

   184

    exit_success

   185

    ;;

   186

   187

stop)

   188

    echo -n "Shutting down EtherCAT master @VERSION@ "

   189

   190

    # unload EtherCAT device modules

   191

    for MODULE in ${DEVICE_MODULES} master; do

   192

        ECMODULE=ec_${MODULE}

   193

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

   194

            continue # ec_* module not loaded

   195

        fi

   196

        if ! ${RMMOD} ${ECMODULE}; then

   197

            exit_fail

   198

        fi;

   199

    done

   200

   201

    sleep 1

   202

   203

    # reload previous modules

   204

    for MODULE in ${DEVICE_MODULES}; do

   205

        if ! ${MODPROBE} ${MODPROBE_FLAGS} ${MODULE}; then

   206

            echo Warning: Failed to restore ${MODULE}.

   207

        fi

   208

    done

   209

   210

    exit_success

   211

    ;;

   212

   213

restart)

   214

    $0 stop || exit 1

   215

    sleep 1

   216

    $0 start

   217

    ;;

   218

   219

status)

   220

    echo "Checking for EtherCAT master @VERSION@ "

   221

   222

    # count masters in configuration file

   223

    MASTER_COUNT=0

   224

    while true; do

   225

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

   226

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

   227

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

   228

    done

   229

   230

    RESULT=0

   231

   232

    for i in `seq 0 $(expr ${MASTER_COUNT} - 1)`; do

   233

        echo -n "Master${i} "

   234

   235

        # Check if the master is in idle or operation phase

   236

        ${ETHERCAT} master --master ${i} 2>/dev/null | \

   237

            grep -qE 'Phase:[[:space:]]*Idle|Phase:[[:space:]]*Operation'

   238

        EXITCODE=$?

   239

   240

        if [ ${EXITCODE} -eq 0 ]; then

   241

            print_running

   242

        else

   243

            print_dead

   244

            RESULT=1

   245

        fi

   246

    done

   247

   248

    exit ${RESULT}

   249

    ;;

   250

   251

*)

   252

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

   253

    ;;

   254

   255

esac

   256

   257

if [ -r /etc/rc.status ]; then

   258

    rc_exit

   259

else

   260

    exit 1

   261

fi

   262

   263

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