1

#!/usr/bin/perl

     2

     3

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

     4

#

     5

#  e c _ l i s t . p l

     6

#

     7

#  Userspace tool for listing EtherCAT slaves.

     8

#

     9

#  $Id: slave.c 340 2006-04-11 10:17:30Z fp $

    10

#

    11

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

    12

    13

use strict;

    14

use Getopt::Std;

    15

    16

my $master_index;

    17

my $master_dir;

    18

    19

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

    20

    21

&get_options;

    22

&query_master;

    23

exit 0;

    24

    25

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

    26

    27

sub query_master

    28

{

    29

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

    30

    &query_slaves;

    31

}

    32

    33

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

    34

    35

sub query_slaves

    36

{

    37

    my $dirhandle;

    38

    my $slave_dir;

    39

    my $entry;

    40

    my $slave_index;

    41

    my $file_name;

    42

    my $vendor_name;

    43

    my @slaves;

    44

    my $slave;

    45

    my $abs;

    46

    47

    unless (opendir $dirhandle, $master_dir) {

    48

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

    49

	exit 1;

    50

    }

    51

    52

    while ($entry = readdir $dirhandle) {

    53

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

    54

	$slave_dir = $master_dir . "/" . $entry;

    55

    56

	$slave = {};

    57

	$slave->{'ring_position'} =

    58

	    &read_integer("$slave_dir/ring_position");

    59

	$slave->{'coupler_address'} =

    60

	    &read_string("$slave_dir/coupler_address");

    61

	$slave->{'vendor_name'} =

    62

	    &read_string("$slave_dir/vendor_name");

    63

	$slave->{'product_name'} =

    64

	    &read_string("$slave_dir/product_name");

    65

	$slave->{'product_desc'} =

    66

	    &read_string("$slave_dir/product_desc");

    67

	$slave->{'type'} =

    68

	    &read_string("$slave_dir/type");

    69

    70

	push @slaves, $slave;

    71

    }

    72

    closedir $dirhandle;

    73

    74

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

    75

    76

    print "EtherCAT bus listing for master $master_index:\n";

    77

    for $slave (@slaves) {

    78

	if ($slave->{'type'} eq "coupler") {

    79

	    print "--------------------------------------------------------\n";

    80

	}

    81

    82

	$abs = sprintf "%i", $slave->{'ring_position'};

    83

	printf(" %3s %8s   %-12s %-10s %s\n", $abs,

    84

	       $slave->{'coupler_address'}, $slave->{'vendor_name'},

    85

	       $slave->{'product_name'}, $slave->{'product_desc'});

    86

    }

    87

}

    88

    89

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

    90

    91

sub read_string

    92

{

    93

    (my $file_name) = @_;

    94

    my $data;

    95

    96

    $data = `cat $file_name 2>/dev/null`;

    97

    if ($?) {

    98

	print "ERROR: Unable to read string $file_name!\n";

    99

	exit 1;

   100

    }

   101

   102

    chomp $data;

   103

    return $data;

   104

}

   105

   106

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

   107

   108

sub read_integer

   109

{

   110

    (my $file_name) = @_;

   111

   112

    if (`cat $file_name 2>/dev/null` !~ /^(\d+)$/) {

   113

	print "ERROR: Unable to read integer $file_name!\n";

   114

	exit 1;

   115

    }

   116

   117

    return int $1;

   118

}

   119

   120

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

   121

   122

sub get_options

   123

{

   124

    my %opt;

   125

    my $optret;

   126

   127

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

   128

   129

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

   130

   131

    if (defined $opt{'m'}) {

   132

	$master_index = $opt{'m'};

   133

    }

   134

    else {

   135

	$master_index = 0;

   136

    }

   137

}

   138

   139

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

   140

   141

sub print_usage

   142

{

   143

    print "Usage: ec_list [OPTIONS]\n";

   144

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

   145

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

   146

    exit 0;

   147

}

   148

   149

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