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

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

    33

    34

### BEGIN INIT INFO

    35

# Provides:          ethercat

    36

# Required-Start:    $local_fs $syslog $network

    37

# Should-Start:      $time ntp

    38

# Required-Stop:     $local_fs $syslog $network

    39

# Should-Stop:       $time ntp

    40

# Default-Start:     3 5

    41

# Default-Stop:      0 1 2 6

    42

# Short-Description: EtherCAT master

    43

# Description:       EtherCAT master @VERSION@

    44

### END INIT INFO

    45

    46

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

    47

    48

MODPROBE=/sbin/modprobe

    49

RMMOD=/sbin/rmmod

    50

MODINFO=/sbin/modinfo

    51

ETHERCAT=@prefix@/bin/ethercat

    52

MASTER_ARGS=

    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

exit_success() {

    72

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

    73

        rc_reset

    74

        rc_status -v

    75

        rc_exit

    76

    else

    77

        echo " done"

    78

        exit 0

    79

    fi

    80

}

    81

    82

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

    83

    84

exit_fail() {

    85

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

    86

        rc_failed

    87

        rc_status -v

    88

        rc_exit

    89

    else

    90

        echo " failed"

    91

        exit 1

    92

    fi

    93

}

    94

    95

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

    96

    97

print_running() {

    98

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

    99

        rc_reset

   100

        rc_status -v

   101

    else

   102

        echo " running"

   103

    fi

   104

}

   105

   106

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

   107

   108

print_dead() {

   109

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

   110

        rc_failed

   111

        rc_status -v

   112

    else

   113

        echo " dead"

   114

    fi

   115

}

   116

   117

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

   118

   119

parse_mac_address() {

   120

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

   121

        MAC=""

   122

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

   123

        MAC=${1}

   124

    else

   125

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

   126

        exit_fail

   127

    fi 

   128

}

   129

   130

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

   131

   132

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

   133

    . /etc/rc.status

   134

    rc_reset

   135

fi

   136

   137

case "${1}" in

   138

   139

start)

   140

    echo -n "Starting EtherCAT master @VERSION@ "

   141

   142

    # construct DEVICES and BACKUPS from configuration variables

   143

    DEVICES=""

   144

    BACKUPS=""

   145

    MASTER_INDEX=0

   146

    while true; do

   147

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

   148

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

   149

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

   150

   151

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

   152

            DEVICES=${DEVICES},

   153

            BACKUPS=${BACKUPS},

   154

        fi

   155

   156

        parse_mac_address ${DEVICE}

   157

        DEVICES=${DEVICES}${MAC}

   158

   159

        parse_mac_address ${BACKUP}

   160

        BACKUPS=${BACKUPS}${MAC}

   161

   162

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

   163

    done

   164

   165

    # load master module

   166

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

   167

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

   168

        exit_fail

   169

    fi

   170

   171

    # check for modules to replace

   172

    for MODULE in ${DEVICE_MODULES}; do

   173

        ECMODULE=ec_${MODULE}

   174

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

   175

            continue # ec_* module not found

   176

        fi

   177

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

   178

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

   179

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

   180

                    exit_fail

   181

                fi

   182

            fi

   183

        fi

   184

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

   185

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

   186

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

   187

            fi

   188

            exit_fail

   189

        fi

   190

    done

   191

   192

    exit_success

   193

    ;;

   194

   195

stop)

   196

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

   197

   198

    # unload EtherCAT device modules

   199

    for MODULE in ${DEVICE_MODULES} master; do

   200

        ECMODULE=ec_${MODULE}

   201

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

   202

            continue # ec_* module not loaded

   203

        fi

   204

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

   205

            exit_fail

   206

        fi;

   207

    done

   208

   209

    sleep 1

   210

   211

    # reload previous modules

   212

    for MODULE in ${DEVICE_MODULES}; do

   213

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

   214

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

   215

                echo Warning: Failed to restore ${MODULE}.

   216

            fi

   217

        fi

   218

    done

   219

   220

    exit_success

   221

    ;;

   222

   223

restart)

   224

    $0 stop || exit 1

   225

    sleep 1

   226

    $0 start

   227

    ;;

   228

   229

status)

   230

    echo "Checking for EtherCAT master @VERSION@ "

   231

   232

    # count masters in configuration file

   233

    MASTER_COUNT=0

   234

    while true; do

   235

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

   236

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

   237

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

   238

    done

   239

   240

    RESULT=0

   241

   242

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

   243

        echo -n "Master${i} "

   244

   245

        # Check if the master is in idle or operation phase

   246

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

   247

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

   248

        EXITCODE=$?

   249

   250

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

   251

            print_running

   252

        else

   253

            print_dead

   254

            RESULT=1

   255

        fi

   256

    done

   257

   258

    exit ${RESULT}

   259

    ;;

   260

   261

*)

   262

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

   263

    ;;

   264

   265

esac

   266

   267

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

   268

    rc_exit

   269

else

   270

    exit 1

   271

fi

   272

   273

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