1

#!/bin/sh

     2

     3

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

     4

#

     5

#  Init script for EtherCAT

     6

#

     7

#  $Id$

     8

#

     9

#  Copyright (C) 2006  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

    14

#  and/or modify it under the terms of the GNU General Public License

    15

#  as published by the Free Software Foundation; either version 2 of the

    16

#  License, or (at your option) any later version.

    17

#

    18

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

    19

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

    20

#  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

    21

#  GNU General Public License for more details.

    22

#

    23

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

    24

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

    25

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

    26

#

    27

#  The right to use EtherCAT Technology is granted and comes free of

    28

#  charge under condition of compatibility of product made by

    29

#  Licensee. People intending to distribute/sell products based on the

    30

#  code, have to sign an agreement to guarantee that products using

    31

#  software based on IgH EtherCAT master stay compatible with the actual

    32

#  EtherCAT specification (which are released themselves as an open

    33

#  standard) as the (only) precondition to have the right to use EtherCAT

    34

#  Technology, IP and trade marks.

    35

#

    36

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

    37

    38

### BEGIN INIT INFO

    39

# Provides:          ethercat

    40

# Required-Start:    $local_fs $syslog $network

    41

# Should-Start:      $time ntp

    42

# Required-Stop:     $local_fs $syslog $network

    43

# Should-Stop:       $time ntp

    44

# Default-Start:     3 5

    45

# Default-Stop:      0 1 2 6

    46

# Short-Description: IgH EtherCAT master modules

    47

# Description:

    48

### END INIT INFO

    49

    50

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

    51

    52

CDEV='EtherCAT'

    53

MODPROBE=/sbin/modprobe

    54

RMMOD=/sbin/rmmod

    55

MODINFO=/sbin/modinfo

    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

function exit_success()

    75

{

    76

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

    77

        rc_reset

    78

        rc_status -v

    79

        rc_exit

    80

    else

    81

        echo " done"

    82

        exit 0

    83

    fi

    84

}

    85

    86

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

    87

    88

function exit_running()

    89

{

    90

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

    91

        rc_reset

    92

        rc_status -v

    93

        rc_exit

    94

    else

    95

        echo " running"

    96

        exit 0

    97

    fi

    98

}

    99

   100

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

   101

   102

function exit_fail()

   103

{

   104

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

   105

        rc_failed

   106

        rc_status -v

   107

        rc_exit

   108

    else

   109

        echo " failed"

   110

        exit 1

   111

    fi

   112

}

   113

   114

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

   115

   116

function exit_dead()

   117

{

   118

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

   119

        rc_failed

   120

        rc_status -v

   121

        rc_exit

   122

    else

   123

        echo " dead"

   124

        exit 1

   125

    fi

   126

}

   127

   128

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

   129

   130

function parse_mac_address()

   131

{

   132

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

   133

        MAC=""

   134

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

   135

        MAC=${1}

   136

    else

   137

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

   138

        exit_fail

   139

    fi 

   140

}

   141

   142

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

   143

   144

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

   145

    . /etc/rc.status

   146

    rc_reset

   147

fi

   148

   149

case "${1}" in

   150

   151

start)

   152

    echo -n "Starting EtherCAT master "

   153

   154

    # construct DEVICES and BACKUPS from configuration variables

   155

    DEVICES=""

   156

    BACKUPS=""

   157

    MASTER_INDEX=0

   158

    while true; do

   159

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

   160

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

   161

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

   162

   163

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

   164

            DEVICES=${DEVICES},

   165

            BACKUPS=${BACKUPS},

   166

        fi

   167

   168

        parse_mac_address ${DEVICE}

   169

        DEVICES=${DEVICES}${MAC}

   170

   171

        parse_mac_address ${BACKUP}

   172

        BACKUPS=${BACKUPS}${MAC}

   173

   174

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

   175

    done

   176

    MASTER_INDICES=`seq 0 $((${MASTER_INDEX} - 1))`

   177

   178

    # load master module

   179

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

   180

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

   181

        exit_fail

   182

    fi

   183

   184

    # remove stale device nodes

   185

    rm -f /dev/${CDEV}*

   186

   187

    # get dynamic major number

   188

    MAJOR=$(awk "\$2==\"EtherCAT\" {print \$1}" /proc/devices)

   189

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

   190

        echo "Failed to get device major number!"

   191

        ${RMMOD} ec_master

   192

        exit_fail

   193

    fi

   194

   195

    # create character devices

   196

    for i in ${MASTER_INDICES}; do

   197

        mknod /dev/${CDEV}${i} c ${MAJOR} ${i}

   198

    done

   199

   200

    # check for modules to replace

   201

    for MODULE in ${DEVICE_MODULES}; do

   202

        ECMODULE=ec_${MODULE}

   203

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

   204

            continue # ec_* module not found

   205

        fi

   206

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

   207

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

   208

                exit_fail

   209

            fi

   210

        fi

   211

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

   212

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

   213

            exit_fail

   214

        fi

   215

    done

   216

   217

    exit_success

   218

    ;;

   219

   220

stop)

   221

    echo -n "Shutting down EtherCAT master "

   222

   223

    # unload EtherCAT device modules

   224

    for MODULE in ${DEVICE_MODULES} master; do

   225

        ECMODULE=ec_${MODULE}

   226

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

   227

            continue # ec_* module not loaded

   228

        fi

   229

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

   230

            exit_fail

   231

        fi;

   232

    done

   233

   234

    # remove device nodes

   235

    rm -f /dev/${CDEV}*

   236

   237

    sleep 1

   238

   239

    # reload previous modules

   240

    for MODULE in ${DEVICE_MODULES}; do

   241

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

   242

            echo Warning: Failed to restore ${MODULE}.

   243

        fi

   244

    done

   245

   246

    exit_success

   247

    ;;

   248

   249

restart)

   250

    $0 stop || exit 1

   251

    sleep 1

   252

    $0 start

   253

    ;;

   254

   255

status)

   256

    echo -n "Checking for EtherCAT "

   257

   258

    lsmod | grep -q "^ec_master "

   259

    MASTERS_RUNNING=$?

   260

   261

    ! grep -q "(WAITING)" /sys/ethercat/master*/info

   262

    MASTERS_IDLE=$?

   263

   264

    # master module loaded and masters not waiting for devices?

   265

    if [ ${MASTERS_RUNNING} -eq 0 -a ${MASTERS_IDLE} -eq 0 ]; then

   266

        exit_running

   267

    else

   268

        exit_dead

   269

    fi

   270

    ;;

   271

   272

*)

   273

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

   274

    ;;

   275

   276

esac

   277

   278

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

   279

    rc_exit

   280

else

   281

    exit 1

   282

fi

   283

   284

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