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

MODPROBE=/sbin/modprobe

    51

RMMOD=/sbin/rmmod

    52

MODINFO=/sbin/modinfo

    53

ETHERCAT=@prefix@/bin/ethercat

    54

MASTER_ARGS=

    55

    56

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

    57

    58

ETHERCAT_CONFIG=/etc/sysconfig/ethercat

    59

    60

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

    61

    echo ${ETHERCAT_CONFIG} not existing;

    62

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

    63

        exit 0

    64

    else

    65

        exit 6

    66

    fi

    67

fi

    68

    69

. ${ETHERCAT_CONFIG}

    70

    71

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

    72

    73

exit_success() {

    74

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

    75

        rc_reset

    76

        rc_status -v

    77

        rc_exit

    78

    else

    79

        echo " done"

    80

        exit 0

    81

    fi

    82

}

    83

    84

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

    85

    86

exit_fail() {

    87

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

    88

        rc_failed

    89

        rc_status -v

    90

        rc_exit

    91

    else

    92

        echo " failed"

    93

        exit 1

    94

    fi

    95

}

    96

    97

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

    98

    99

print_running() {

   100

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

   101

        rc_reset

   102

        rc_status -v

   103

    else

   104

        echo " running"

   105

    fi

   106

}

   107

   108

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

   109

   110

print_dead() {

   111

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

   112

        rc_failed

   113

        rc_status -v

   114

    else

   115

        echo " dead"

   116

    fi

   117

}

   118

   119

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

   120

   121

parse_mac_address() {

   122

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

   123

        MAC=""

   124

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

   125

        MAC=${1}

   126

    else

   127

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

   128

        exit_fail

   129

    fi 

   130

}

   131

   132

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

   133

   134

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

   135

    . /etc/rc.status

   136

    rc_reset

   137

fi

   138

   139

case "${1}" in

   140

   141

start)

   142

    echo -n "Starting EtherCAT master @VERSION@ "

   143

   144

    # construct DEVICES and BACKUPS from configuration variables

   145

    DEVICES=""

   146

    BACKUPS=""

   147

    MASTER_INDEX=0

   148

    while true; do

   149

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

   150

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

   151

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

   152

   153

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

   154

            DEVICES=${DEVICES},

   155

            BACKUPS=${BACKUPS},

   156

        fi

   157

   158

        parse_mac_address ${DEVICE}

   159

        DEVICES=${DEVICES}${MAC}

   160

   161

        parse_mac_address ${BACKUP}

   162

        BACKUPS=${BACKUPS}${MAC}

   163

   164

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

   165

    done

   166

   167

    # load master module

   168

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

   169

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

   170

        exit_fail

   171

    fi

   172

   173

    # check for modules to replace

   174

    for MODULE in ${DEVICE_MODULES}; do

   175

        ECMODULE=ec_${MODULE}

   176

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

   177

            continue # ec_* module not found

   178

        fi

   179

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

   180

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

   181

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

   182

                    exit_fail

   183

                fi

   184

            fi

   185

        fi

   186

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

   187

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

   188

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

   189

            fi

   190

            exit_fail

   191

        fi

   192

    done

   193

   194

    exit_success

   195

    ;;

   196

   197

stop)

   198

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

   199

   200

    # unload EtherCAT device modules

   201

    for MODULE in ${DEVICE_MODULES} master; do

   202

        ECMODULE=ec_${MODULE}

   203

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

   204

            continue # ec_* module not loaded

   205

        fi

   206

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

   207

            exit_fail

   208

        fi;

   209

    done

   210

   211

    sleep 1

   212

   213

    # reload previous modules

   214

    for MODULE in ${DEVICE_MODULES}; do

   215

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

   216

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

   217

                echo Warning: Failed to restore ${MODULE}.

   218

            fi

   219

        fi

   220

    done

   221

   222

    exit_success

   223

    ;;

   224

   225

restart)

   226

    $0 stop || exit 1

   227

    sleep 1

   228

    $0 start

   229

    ;;

   230

   231

status)

   232

    echo "Checking for EtherCAT master @VERSION@ "

   233

   234

    # count masters in configuration file

   235

    MASTER_COUNT=0

   236

    while true; do

   237

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

   238

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

   239

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

   240

    done

   241

   242

    RESULT=0

   243

   244

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

   245

        echo -n "Master${i} "

   246

   247

        # Check if the master is in idle or operation phase

   248

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

   249

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

   250

        EXITCODE=$?

   251

   252

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

   253

            print_running

   254

        else

   255

            print_dead

   256

            RESULT=1

   257

        fi

   258

    done

   259

   260

    exit ${RESULT}

   261

    ;;

   262

   263

*)

   264

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

   265

    ;;

   266

   267

esac

   268

   269

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

   270

    rc_exit

   271

else

   272

    exit 1

   273

fi

   274

   275

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