|
1 /***************************************************************************** |
|
2 * |
|
3 * Copyright (C) 2006-2017 Florian Pose, Ingenieurgemeinschaft IgH |
|
4 * |
|
5 * This file is part of the IgH EtherCAT Master. |
|
6 * |
|
7 * The IgH EtherCAT Master is free software; you can redistribute it and/or |
|
8 * modify it under the terms of the GNU General Public License version 2, as |
|
9 * published by the Free Software Foundation. |
|
10 * |
|
11 * The IgH EtherCAT Master is distributed in the hope that it will be useful, |
|
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General |
|
14 * Public License for more details. |
|
15 * |
|
16 * You should have received a copy of the GNU General Public License along |
|
17 * with the IgH EtherCAT Master; if not, write to the Free Software |
|
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
|
19 * |
|
20 * --- |
|
21 * |
|
22 * The license mentioned above concerns the source code only. Using the |
|
23 * EtherCAT technology and brand is only permitted in compliance with the |
|
24 * industrial property and similar rights of Beckhoff Automation GmbH. |
|
25 * |
|
26 ****************************************************************************/ |
|
27 |
|
28 #include <iostream> |
|
29 #include <iomanip> |
|
30 using namespace std; |
|
31 |
|
32 #include "CommandCrc.h" |
|
33 #include "MasterDevice.h" |
|
34 |
|
35 /*****************************************************************************/ |
|
36 |
|
37 CommandCrc::CommandCrc(): |
|
38 Command("crc", "CRC error register diagnosis.") |
|
39 { |
|
40 } |
|
41 |
|
42 /*****************************************************************************/ |
|
43 |
|
44 string CommandCrc::helpString(const string &binaryBaseName) const |
|
45 { |
|
46 stringstream str; |
|
47 |
|
48 str << binaryBaseName << " " << getName() |
|
49 << " [OPTIONS]" << endl |
|
50 << endl |
|
51 << getBriefDescription() << endl |
|
52 << endl |
|
53 << "CRC - CRC Error Counter 0x300, 0x302, 0x304, 0x306" |
|
54 << endl |
|
55 << "PHY - Physical Interface Error Counter 0x301, 0x303, 0x305, 0x307" |
|
56 << endl |
|
57 << "FWD - Forwarded RX Error Counter 0x308, 0x309, 0x30a, 0x30b" |
|
58 << endl |
|
59 << "LNK - Lost Link Counter 0x310, 0x311, 0x312, 0x313" |
|
60 << endl |
|
61 << endl; |
|
62 |
|
63 return str.str(); |
|
64 } |
|
65 |
|
66 /****************************************************************************/ |
|
67 |
|
68 #define NUM_PORTS (4) |
|
69 |
|
70 void CommandCrc::execute(const StringVector &args) |
|
71 { |
|
72 |
|
73 MasterDevice m(getSingleMasterIndex()); |
|
74 m.open(MasterDevice::Read); |
|
75 |
|
76 ec_ioctl_master_t master; |
|
77 m.getMaster(&master); |
|
78 |
|
79 |
|
80 cout << " |"; |
|
81 for (unsigned int port = 0; port < NUM_PORTS; port++) { |
|
82 cout << "Port " << port << " |"; |
|
83 } |
|
84 cout << endl; |
|
85 |
|
86 cout << " |"; |
|
87 for (unsigned int port = 0; port < NUM_PORTS; port++) { |
|
88 cout << "CRC PHY FWD LNK|"; |
|
89 } |
|
90 cout << endl; |
|
91 |
|
92 ec_ioctl_slave_reg_t io; |
|
93 io.emergency = 0; |
|
94 io.address = 0x0300; |
|
95 io.size = 20; |
|
96 io.data = new uint8_t[20]; |
|
97 |
|
98 for (unsigned int i = 0; i < master.slave_count; i++) { |
|
99 |
|
100 io.slave_position = i; |
|
101 try { |
|
102 m.readReg(&io); |
|
103 } catch (MasterDeviceException &e) { |
|
104 delete [] io.data; |
|
105 throw e; |
|
106 } |
|
107 |
|
108 cout << setw(3) << i << "|"; |
|
109 for (int port = 0; port < 4; port++) { |
|
110 cout << setw(3) << (unsigned int) io.data[ 0 + port * 2]; // CRC |
|
111 cout << setw(4) << (unsigned int) io.data[ 1 + port * 2]; // PHY |
|
112 cout << setw(4) << (unsigned int) io.data[ 8 + port]; // FWD |
|
113 cout << setw(4) << (unsigned int) io.data[16 + port]; // LNK |
|
114 cout << "|"; |
|
115 } |
|
116 |
|
117 ec_ioctl_slave_t slave; |
|
118 m.getSlave(&slave, i); |
|
119 std::string slaveName(slave.name); |
|
120 slaveName = slaveName.substr(0, 11); |
|
121 cout << slaveName << endl; |
|
122 } |
|
123 |
|
124 delete [] io.data; |
|
125 } |
|
126 |
|
127 /*****************************************************************************/ |