1

#!/bin/sh

     2

     3

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

     4

#

     5

#  Start script for EtherCAT to use with systemd

     6

#

     7

#  $Id$

     8

#

     9

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

    29

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

    30

#  industrial property and similar rights of Beckhoff Automation GmbH.

    31

#

    32

#  vim: expandtab sw=4 tw=78

    33

#

    34

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

    35

    36

MODPROBE=/sbin/modprobe

    37

RMMOD=/sbin/rmmod

    38

MODINFO=/sbin/modinfo

    39

    40

ETHERCAT=@prefix@/bin/ethercat

    41

    42

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

    43

    44

ETHERCAT_CONFIG=/etc/ethercat.conf

    45

    46

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

    47

    echo ${ETHERCAT_CONFIG} not existing;

    48

    exit 6

    49

fi

    50

    51

. ${ETHERCAT_CONFIG}

    52

    53

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

    54

    55

parse_mac_address() {

    56

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

    57

        MAC=""

    58

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

    59

        MAC=${1}

    60

    else

    61

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

    62

        exit 1

    63

    fi

    64

}

    65

    66

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

    67

    68

case "${1}" in

    69

    70

start)

    71

    # construct DEVICES and BACKUPS from configuration variables

    72

    DEVICES=""

    73

    BACKUPS=""

    74

    MASTER_INDEX=0

    75

    76

    while true; do

    77

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

    78

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

    79

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

    80

    81

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

    82

            DEVICES=${DEVICES},

    83

            BACKUPS=${BACKUPS},

    84

        fi

    85

    86

        parse_mac_address ${DEVICE}

    87

        DEVICES=${DEVICES}${MAC}

    88

    89

        parse_mac_address ${BACKUP}

    90

        BACKUPS=${BACKUPS}${MAC}

    91

    92

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

    93

    done

    94

    95

    # load master module

    96

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

    97

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

    98

        exit 1

    99

    fi

   100

   101

    LOADED_MODULES=ec_master

   102

   103

    # check for modules to replace

   104

    for MODULE in ${DEVICE_MODULES}; do

   105

        ECMODULE=ec_${MODULE}

   106

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

   107

            continue # ec_* module not found

   108

        fi

   109

   110

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

   111

            # try to unload standard module

   112

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

   113

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

   114

                    ${RMMOD} ${LOADED_MODULES}

   115

                    exit 1

   116

                fi

   117

            fi

   118

        fi

   119

   120

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

   121

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

   122

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

   123

            fi

   124

            ${RMMOD} ${LOADED_MODULES}

   125

            exit 1

   126

        fi

   127

   128

        LOADED_MODULES=${ECMODULE} ${LOADED_MODULES}

   129

    done

   130

   131

    exit 0

   132

    ;;

   133

   134

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

   135

   136

stop)

   137

    # unload EtherCAT device modules

   138

    for MODULE in ${DEVICE_MODULES} master; do

   139

        ECMODULE=ec_${MODULE}

   140

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

   141

            continue # ec_* module not loaded

   142

        fi

   143

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

   144

            exit 1

   145

        fi;

   146

    done

   147

   148

    sleep 1

   149

   150

    # load standard modules again

   151

    for MODULE in ${DEVICE_MODULES}; do

   152

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

   153

            continue

   154

        fi

   155

        ${MODPROBE} ${MODPROBE_FLAGS} ${MODULE}

   156

    done

   157

   158

    exit 0

   159

    ;;

   160

   161

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

   162

   163

restart)

   164

    $0 stop || exit 1

   165

    sleep 1

   166

    $0 start

   167

    ;;

   168

   169

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

   170

   171

status)

   172

    echo "Checking for EtherCAT master @VERSION@ "

   173

   174

    # count masters in configuration file

   175

    MASTER_COUNT=0

   176

    while true; do

   177

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

   178

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

   179

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

   180

    done

   181

   182

    RESULT=0

   183

   184

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

   185

        echo -n "Master${i} "

   186

   187

        # Check if the master is in idle or operation phase

   188

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

   189

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

   190

        EXITCODE=$?

   191

   192

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

   193

            echo " running"

   194

        else

   195

            echo " dead"

   196

            RESULT=1

   197

        fi

   198

    done

   199

   200

    exit ${RESULT}

   201

    ;;

   202

   203

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

   204

   205

*)

   206

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

   207

    exit 1

   208

    ;;

   209

esac

   210

   211

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