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

    53

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

    54

    55

ETHERCAT_CONFIG=/etc/sysconfig/ethercat

    56

    57

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

    58

    echo ${ETHERCAT_CONFIG} not existing;

    59

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

    60

	exit 0

    61

    else

    62

	exit 6

    63

    fi

    64

fi

    65

    66

. ${ETHERCAT_CONFIG}

    67

    68

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

    69

    70

exit_success() {

    71

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

    72

        rc_reset

    73

        rc_status -v

    74

        rc_exit

    75

    else

    76

        echo " done"

    77

        exit 0

    78

    fi

    79

}

    80

    81

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

    82

    83

exit_fail() {

    84

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

    85

        rc_failed

    86

        rc_status -v

    87

        rc_exit

    88

    else

    89

        echo " failed"

    90

        exit 1

    91

    fi

    92

}

    93

    94

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

    95

    96

print_running() {

    97

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

    98

        rc_reset

    99

        rc_status -v

   100

    else

   101

        echo " running"

   102

    fi

   103

}

   104

   105

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

   106

   107

print_dead() {

   108

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

   109

        rc_failed

   110

        rc_status -v

   111

    else

   112

        echo " dead"

   113

    fi

   114

}

   115

   116

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

   117

   118

parse_mac_address() {

   119

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

   120

        MAC=""

   121

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

   122

        MAC=${1}

   123

    else

   124

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

   125

        exit_fail

   126

    fi 

   127

}

   128

   129

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

   130

   131

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

   132

    . /etc/rc.status

   133

    rc_reset

   134

fi

   135

   136

case "${1}" in

   137

   138

start)

   139

    echo -n "Starting EtherCAT master @VERSION@ "

   140

   141

    # construct DEVICES and BACKUPS from configuration variables

   142

    DEVICES=""

   143

    BACKUPS=""

   144

    MASTER_INDEX=0

   145

    while true; do

   146

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

   147

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

   148

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

   149

   150

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

   151

            DEVICES=${DEVICES},

   152

            BACKUPS=${BACKUPS},

   153

        fi

   154

   155

        parse_mac_address ${DEVICE}

   156

        DEVICES=${DEVICES}${MAC}

   157

   158

        parse_mac_address ${BACKUP}

   159

        BACKUPS=${BACKUPS}${MAC}

   160

   161

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

   162

    done

   163

   164

    # load master module

   165

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

   166

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

   167

        exit_fail

   168

    fi

   169

   170

    # check for modules to replace

   171

    for MODULE in ${DEVICE_MODULES}; do

   172

        ECMODULE=ec_${MODULE}

   173

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

   174

            continue # ec_* module not found

   175

        fi

   176

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

   177

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

   178

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

   179

                    exit_fail

   180

                fi

   181

            fi

   182

        fi

   183

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

   184

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

   185

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

   186

            fi

   187

            exit_fail

   188

        fi

   189

    done

   190

   191

    exit_success

   192

    ;;

   193

   194

stop)

   195

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

   196

   197

    # unload EtherCAT device modules

   198

    for MODULE in ${DEVICE_MODULES} master; do

   199

        ECMODULE=ec_${MODULE}

   200

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

   201

            continue # ec_* module not loaded

   202

        fi

   203

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

   204

            exit_fail

   205

        fi;

   206

    done

   207

   208

    sleep 1

   209

   210

    # reload previous modules

   211

    for MODULE in ${DEVICE_MODULES}; do

   212

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

   213

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

   214

                echo Warning: Failed to restore ${MODULE}.

   215

            fi

   216

        fi

   217

    done

   218

   219

    exit_success

   220

    ;;

   221

   222

restart)

   223

    $0 stop || exit 1

   224

    sleep 1

   225

    $0 start

   226

    ;;

   227

   228

status)

   229

    echo "Checking for EtherCAT master @VERSION@ "

   230

   231

    # count masters in configuration file

   232

    MASTER_COUNT=0

   233

    while true; do

   234

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

   235

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

   236

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

   237

    done

   238

   239

    RESULT=0

   240

   241

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

   242

        echo -n "Master${i} "

   243

   244

        # Check if the master is in idle or operation phase

   245

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

   246

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

   247

        EXITCODE=$?

   248

   249

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

   250

            print_running

   251

        else

   252

            print_dead

   253

            RESULT=1

   254

        fi

   255

    done

   256

   257

    exit ${RESULT}

   258

    ;;

   259

   260

*)

   261

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

   262

    ;;

   263

   264

esac

   265

   266

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

   267

    rc_exit

   268

else

   269

    exit 1

   270

fi

   271

   272

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