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

#  ---

    27

#

    28

#  The license mentioned above concerns the source code only. Using the EtherCAT

    29

#  technology and brand is only permitted in compliance with the industrial

    30

#  property and similar rights of Beckhoff Automation GmbH.

    31

#

    32

#  vim: expandtab

    33

#

    34

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

    35

    36

### BEGIN INIT INFO

    37

# Provides:          ethercat

    38

# Required-Start:    $local_fs $syslog $network

    39

# Should-Start:      $time ntp

    40

# Required-Stop:     $local_fs $syslog $network

    41

# Should-Stop:       $time ntp

    42

# Default-Start:     3 5

    43

# Default-Stop:      0 1 2 6

    44

# Short-Description: EtherCAT master

    45

# Description:       EtherCAT master @VERSION@

    46

### END INIT INFO

    47

    48

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

    49

    50

LSMOD=/sbin/lsmod

    51

MODPROBE=/sbin/modprobe

    52

RMMOD=/sbin/rmmod

    53

MODINFO=/sbin/modinfo

    54

ETHERCAT=@prefix@/bin/ethercat

    55

MASTER_ARGS=

    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

    74

exit_success() {

    75

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

    76

        rc_reset

    77

        rc_status -v

    78

        rc_exit

    79

    else

    80

        echo " done"

    81

        exit 0

    82

    fi

    83

}

    84

    85

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

    86

    87

exit_fail() {

    88

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

    89

        rc_failed

    90

        rc_status -v

    91

        rc_exit

    92

    else

    93

        echo " failed"

    94

        exit 1

    95

    fi

    96

}

    97

    98

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

    99

   100

print_running() {

   101

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

   102

        rc_reset

   103

        rc_status -v

   104

    else

   105

        echo " running"

   106

    fi

   107

}

   108

   109

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

   110

   111

print_dead() {

   112

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

   113

        rc_failed

   114

        rc_status -v

   115

    else

   116

        echo " dead"

   117

    fi

   118

}

   119

   120

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

   121

   122

parse_mac_address() {

   123

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

   124

        MAC=""

   125

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

   126

        MAC=${1}

   127

    else

   128

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

   129

        exit_fail

   130

    fi

   131

}

   132

   133

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

   134

   135

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

   136

    . /etc/rc.status

   137

    rc_reset

   138

fi

   139

   140

case "${1}" in

   141

   142

start)

   143

    echo -n "Starting EtherCAT master @VERSION@ "

   144

   145

    # construct DEVICES and BACKUPS from configuration variables

   146

    DEVICES=""

   147

    BACKUPS=""

   148

    MASTER_INDEX=0

   149

    while true; do

   150

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

   151

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

   152

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

   153

   154

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

   155

            DEVICES=${DEVICES},

   156

            BACKUPS=${BACKUPS},

   157

        fi

   158

   159

        parse_mac_address ${DEVICE}

   160

        DEVICES=${DEVICES}${MAC}

   161

   162

        parse_mac_address ${BACKUP}

   163

        BACKUPS=${BACKUPS}${MAC}

   164

   165

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

   166

    done

   167

   168

    # load master module

   169

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

   170

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

   171

        exit_fail

   172

    fi

   173

   174

    # check for modules to replace

   175

    for MODULE in ${DEVICE_MODULES}; do

   176

        ECMODULE=ec_${MODULE}

   177

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

   178

            continue # ec_* module not found

   179

        fi

   180

        if [ ${MODULE} != "generic" ]; then

   181

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

   182

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

   183

                    exit_fail

   184

                fi

   185

            fi

   186

        fi

   187

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

   188

            if [ ${MODULE} != "generic" ]; then

   189

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

   190

            fi

   191

            exit_fail

   192

        fi

   193

    done

   194

   195

    exit_success

   196

    ;;

   197

   198

stop)

   199

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

   200

   201

    # unload EtherCAT device modules

   202

    for MODULE in ${DEVICE_MODULES} master; do

   203

        ECMODULE=ec_${MODULE}

   204

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

   205

            continue # ec_* module not loaded

   206

        fi

   207

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

   208

            exit_fail

   209

        fi;

   210

    done

   211

   212

    sleep 1

   213

   214

    # reload previous modules

   215

    for MODULE in ${DEVICE_MODULES}; do

   216

        if [ ${MODULE} != "generic" ]; then

   217

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

   218

                echo Warning: Failed to restore ${MODULE}.

   219

            fi

   220

        fi

   221

    done

   222

   223

    exit_success

   224

    ;;

   225

   226

restart)

   227

    $0 stop || exit 1

   228

    sleep 1

   229

    $0 start

   230

    ;;

   231

   232

status)

   233

    echo "Checking for EtherCAT master @VERSION@ "

   234

   235

    # count masters in configuration file

   236

    MASTER_COUNT=0

   237

    while true; do

   238

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

   239

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

   240

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

   241

    done

   242

   243

    RESULT=0

   244

   245

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

   246

        echo -n "Master${i} "

   247

   248

        # Check if the master is in idle or operation phase

   249

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

   250

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

   251

        EXITCODE=$?

   252

   253

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

   254

            print_running

   255

        else

   256

            print_dead

   257

            RESULT=1

   258

        fi

   259

    done

   260

   261

    exit ${RESULT}

   262

    ;;

   263

   264

*)

   265

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

   266

    ;;

   267

   268

esac

   269

   270

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

   271

    rc_exit

   272

else

   273

    exit 1

   274

fi

   275

   276

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