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

device="ecxml"

    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

#

    72

#  Function for setting up the EoE bridge

    73

#

    74

build_eoe_bridge()

    75

{

    76

    if [ -z "$EOE_BRIDGE" ]; then return; fi

    77

    78

    EOEIF=`/sbin/ifconfig -a | grep -o -E "^eoe[0-9]+ "`

    79

    80

    # add bridge, if it does not already exist

    81

    if ! /sbin/brctl show | grep -E -q "^$EOE_BRIDGE"; then

    82

        if ! /sbin/brctl addbr $EOE_BRIDGE; then

    83

	    /bin/false

    84

	    rc_status -v

    85

	    rc_exit

    86

	fi

    87

    fi

    88

    89

    # check if specified interfaces are bridged

    90

    for interf in $EOEIF $EOE_EXTRA_INTERFACES; do

    91

	# interface is already part of the bridge

    92

	if /sbin/brctl show $EOE_BRIDGE | grep -E -q $interf

    93

	    then continue

    94

	fi

    95

	# clear IP address and open interface

    96

	if ! /sbin/ifconfig $interf 0.0.0.0 up; then

    97

	    /bin/false

    98

	    rc_status -v

    99

	    rc_exit

   100

	fi

   101

	# add interface to the bridge

   102

	if ! /sbin/brctl addif $EOE_BRIDGE $interf; then

   103

	    /bin/false

   104

	    rc_status -v

   105

	    rc_exit

   106

	fi

   107

    done

   108

   109

    # configure IP on bridge

   110

    if [ -n "$EOE_IP_ADDRESS" -a -n "$EOE_IP_NETMASK" ]; then

   111

	if ! /sbin/ifconfig $EOE_BRIDGE $EOE_IP_ADDRESS \

   112

	    netmask $EOE_IP_NETMASK; then

   113

	    /bin/false

   114

	    rc_status -v

   115

	    rc_exit

   116

	fi

   117

    fi

   118

   119

    # open bridge

   120

    if ! /sbin/ifconfig $EOE_BRIDGE up; then

   121

	/bin/false

   122

	rc_status -v

   123

	rc_exit

   124

    fi

   125

   126

    # install new default gateway

   127

    if [ -n "$EOE_GATEWAY" ]; then

   128

	while /sbin/route -n | grep -E -q "^0.0.0.0"; do

   129

	    if ! /sbin/route del default; then

   130

		echo "Failed to remove route!" 1>&2

   131

		/bin/false

   132

		rc_status -v

   133

		rc_exit

   134

	    fi

   135

	done

   136

	if ! /sbin/route add default gw $EOE_GATEWAY; then

   137

	    /bin/false

   138

	    rc_status -v

   139

	    rc_exit

   140

	fi

   141

    fi

   142

}

   143

   144

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

   145

   146

. /etc/rc.status

   147

rc_reset

   148

   149

case "$1" in

   150

   151

    start)

   152

	echo -n "Starting EtherCAT master "

   153

   154

	if [ -z "$DEVICE_INDEX" ]; then

   155

	    echo "ERROR: DEVICE_INDEX not set!"

   156

	    /bin/false

   157

	    rc_status -v

   158

	    rc_exit

   159

	fi

   160

   161

	if [ -z "$EOE_INTERFACES" ]; then

   162

            # support legacy sysconfig files

   163

	    if [ -n "$EOE_DEVICES" ]; then

   164

		EOE_INTERFACES=$EOE_DEVICES

   165

	    else

   166

		EOE_INTERFACES=0

   167

	    fi

   168

	fi

   169

   170

        # unload conflicting modules at first

   171

	for mod in 8139too; do

   172

	    if lsmod | grep "^$mod " > /dev/null; then

   173

		if ! rmmod $mod; then

   174

		    /bin/false

   175

		    rc_status -v

   176

		    rc_exit

   177

		fi

   178

	    fi

   179

	done

   180

   181

        # load master module

   182

	if ! modprobe ec_master ec_eoeif_count=$EOE_INTERFACES; then

   183

	    modprobe 8139too

   184

	    /bin/false

   185

	    rc_status -v

   186

	    rc_exit

   187

	fi

   188

   189

	# remove stale device node

   190

	rm -f /dev/${device}0

   191

   192

	# get dynamic major number

   193

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

   194

   195

	# create character device

   196

	mknod /dev/${device}0 c $major 0

   197

   198

	# load device module

   199

	if ! modprobe ec_8139too ec_device_index=$DEVICE_INDEX; then

   200

	    rmmod ec_master

   201

	    modprobe 8139too

   202

	    /bin/false

   203

	    rc_status -v

   204

	    rc_exit

   205

	fi

   206

   207

	# build EoE bridge

   208

	build_eoe_bridge

   209

   210

	rc_status -v

   211

	;;

   212

   213

    stop)

   214

	echo -n "Shutting down EtherCAT master "

   215

   216

	# unload modules

   217

	for mod in ec_8139too ec_master; do

   218

	    if lsmod | grep "^$mod " > /dev/null; then

   219

		if ! rmmod $mod; then

   220

		    /bin/false

   221

		    rc_status -v

   222

		    rc_exit

   223

		fi;

   224

	    fi;

   225

	done

   226

   227

	# remove device node

   228

	rm -f /dev/${device}0

   229

   230

	sleep 1

   231

   232

	# reload previous modules

   233

	if ! modprobe 8139too; then

   234

	    echo "Warning: Failed to restore 8139too module."

   235

	fi

   236

   237

	rc_status -v

   238

	;;

   239

   240

    restart)

   241

	$0 stop || exit 1

   242

	sleep 1

   243

	$0 start

   244

	rc_status

   245

	;;

   246

   247

    status)

   248

	echo -n "Checking for EtherCAT "

   249

   250

	lsmod | grep "^ec_master " > /dev/null

   251

	master_running=$?

   252

	lsmod | grep "^ec_8139too " > /dev/null

   253

	device_running=$?

   254

   255

	# master module and device module loaded?

   256

	test $master_running -eq 0 -a $device_running -eq 0

   257

   258

	rc_status -v

   259

	;;

   260

   261

    bridge)

   262

	echo -n "Building EoE bridge "

   263

	build_eoe_bridge

   264

	rc_status -v

   265

	;;

   266

   267

    *)

   268

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

   269

	;;

   270

   271

esac

   272

   273

rc_exit

   274

   275

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