1

#!/usr/bin/perl

     2

     3

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

     4

#

     5

#  l s e c  -  List EtherCAT

     6

#

     7

#  Userspace tool for listing EtherCAT slaves.

     8

#

     9

#  $Id$

    10

#

    11

#  Copyright (C) 2006  Florian Pose, Ingenieurgemeinschaft IgH

    12

#

    13

#  This file is part of the IgH EtherCAT Master.

    14

#

    15

#  The IgH EtherCAT Master is free software; you can redistribute it

    16

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

    17

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

    18

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

    19

#

    20

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

    21

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

    22

#  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

    23

#  GNU General Public License for more details.

    24

#

    25

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

    26

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

    27

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

    28

#

    29

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

    30

#  charge under condition of compatibility of product made by

    31

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

    32

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

    33

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

    34

#  EtherCAT specification (which are released themselves as an open

    35

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

    36

#  Technology, IP and trade marks.

    37

#

    38

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

    39

    40

require 'sys/ioctl.ph';

    41

    42

use strict;

    43

use Getopt::Std;

    44

    45

my %opt;

    46

my $master_index;

    47

my $master_dir;

    48

my $term_width;

    49

    50

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

    51

    52

$term_width = &get_terminal_width;

    53

&get_options;

    54

&query_master;

    55

exit 0;

    56

    57

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

    58

    59

sub query_master

    60

{

    61

    $master_dir = "/sys/ethercat" . $master_index;

    62

    &query_slaves;

    63

}

    64

    65

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

    66

    67

sub query_slaves

    68

{

    69

    my $dirhandle;

    70

    my $entry;

    71

    my @slaves;

    72

    my $slave;

    73

    my $abs;

    74

    my $line;

    75

    my $ring_cols;

    76

    my $adv_cols;

    77

    my $fmt;

    78

    my $cols;

    79

    80

    unless (opendir $dirhandle, $master_dir) {

    81

		print "Failed to open directory \"$master_dir\".\n";

    82

		exit 1;

    83

    }

    84

    85

    while ($entry = readdir $dirhandle) {

    86

        next unless $entry =~ /^slave(\d+)$/;

    87

    88

		$slave = {};

    89

    90

		open INFO, "$master_dir/$entry/info" or die

    91

			"ERROR: Failed to open $master_dir/$entry/info";

    92

    93

		while ($line = <INFO>) {

    94

			if ($line =~ /^Name: (.*)$/) {

    95

				$slave->{'name'} = $1;

    96

			}

    97

			elsif ($line =~ /^Ring position: (\d+)$/) {

    98

				$slave->{'ring_position'} = $1;

    99

			}

   100

			elsif ($line =~ /^Advanced position: (\d+:\d+)$/) {

   101

				$slave->{'advanced_position'} = $1;

   102

			}

   103

			elsif ($line =~ /^State: (.+)$/) {

   104

				$slave->{'state'} = $1;

   105

			}

   106

			elsif ($line =~ /^Coupler: ([a-z]+)$/) {

   107

				$slave->{'coupler'} = $1;

   108

			}

   109

		}

   110

   111

		close INFO;

   112

   113

		push @slaves, $slave;

   114

    }

   115

    closedir $dirhandle;

   116

   117

    @slaves = sort { $a->{'ring_position'} <=> $b->{'ring_position'} } @slaves;

   118

   119

    $ring_cols = 0;

   120

    $adv_cols = 0;

   121

    for $slave (@slaves) {

   122

	$cols = length $slave->{'ring_position'};

   123

	$ring_cols = $cols if ($cols > $ring_cols);

   124

	$cols = length $slave->{'advanced_position'};

   125

	$adv_cols = $cols if ($cols > $adv_cols);

   126

    }

   127

    $fmt = sprintf " %%%is  %%-%is  %%-6s  %%s\n", $ring_cols, $adv_cols;

   128

   129

    for $slave (@slaves) {

   130

	&print_line if $slave->{'coupler'} eq "yes" and !defined $opt{n};

   131

	printf($fmt, $slave->{'ring_position'}, $slave->{'advanced_position'},

   132

	       $slave->{'state'}, $slave->{'name'});

   133

    }

   134

}

   135

   136

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

   137

   138

sub get_options

   139

{

   140

    my $optret = getopts "m:nh", \%opt;

   141

   142

    &print_usage if defined $opt{h} or $#ARGV > -1 or !$optret;

   143

   144

    if (defined $opt{m}) {

   145

	$master_index = $opt{m};

   146

    }

   147

    else {

   148

	$master_index = 0;

   149

    }

   150

}

   151

   152

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

   153

   154

sub print_usage

   155

{

   156

    my $cmd = `basename $0`;

   157

    chomp $cmd;

   158

    print "Usage: $cmd [OPTIONS]\n";

   159

    print "        -m <IDX>    Query master <IDX>.\n";

   160

    print "        -n          Display no coupler lines.\n";

   161

    print "        -h          Show this help.\n";

   162

    exit 0;

   163

}

   164

   165

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

   166

   167

sub get_terminal_width

   168

{

   169

    my $winsize;

   170

    die "no TIOCGWINSZ " unless defined &TIOCGWINSZ;

   171

    open(TTY, "+</dev/tty") or die "No tty: $!";

   172

    unless (ioctl(TTY, &TIOCGWINSZ, $winsize='')) {

   173

	die sprintf "$0: ioctl TIOCGWINSZ (%08x: $!)\n", &TIOCGWINSZ;

   174

    }

   175

    (my $row, my $col, my $xpixel, my $ypixel) = unpack('S4', $winsize);

   176

    return $col;

   177

}

   178

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

   179

   180

sub print_line

   181

{

   182

    for (my $i = 0; $i < $term_width; $i++) {print "-";}

   183

    print "\n";

   184

}

   185

   186

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