]> git.proxmox.com Git - mirror_iproute2.git/blame - ip/iplink_can.c
projects / mirror_iproute2.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
iproute2/nstat: Bug in displaying icmp stats
[mirror_iproute2.git] / ip / iplink_can.c
CommitLineData
5a204478
WG		 1/*
2 * iplink_can.c CAN device support
3 *
3bbff7df
OH		 4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
5a204478 8 *
3bbff7df 9 * Authors: Wolfgang Grandegger <wg@grandegger.com>
5a204478
WG		 10 */
11
12#include <stdio.h>
13#include <stdlib.h>
14#include <string.h>
15
16#include <linux/can/netlink.h>
17
18#include "rt_names.h"
19#include "utils.h"
20#include "ip_common.h"
21
561e650e 22static void print_usage(FILE *f)
5a204478 23{
561e650e 24 fprintf(f,
5a204478 25 "Usage: ip link set DEVICE type can\n"
3bbff7df
OH		 26 "\t[ bitrate BITRATE [ sample-point SAMPLE-POINT] ] | \n"
27 "\t[ tq TQ prop-seg PROP_SEG phase-seg1 PHASE-SEG1\n "
5a204478
WG		 28 "\t phase-seg2 PHASE-SEG2 [ sjw SJW ] ]\n"
29 "\n"
2bfe0470
OH		 30 "\t[ dbitrate BITRATE [ dsample-point SAMPLE-POINT] ] | \n"
31 "\t[ dtq TQ dprop-seg PROP_SEG dphase-seg1 PHASE-SEG1\n "
32 "\t dphase-seg2 PHASE-SEG2 [ dsjw SJW ] ]\n"
33 "\n"
3bbff7df
OH		 34 "\t[ loopback { on | off } ]\n"
35 "\t[ listen-only { on | off } ]\n"
36 "\t[ triple-sampling { on | off } ]\n"
37 "\t[ one-shot { on | off } ]\n"
38 "\t[ berr-reporting { on | off } ]\n"
2bfe0470 39 "\t[ fd { on | off } ]\n"
5a204478 40 "\n"
3bbff7df
OH		 41 "\t[ restart-ms TIME-MS ]\n"
42 "\t[ restart ]\n"
5a204478 43 "\n"
3bbff7df
OH		 44 "\tWhere: BITRATE := { 1..1000000 }\n"
45 "\t SAMPLE-POINT := { 0.000..0.999 }\n"
46 "\t TQ := { NUMBER }\n"
47 "\t PROP-SEG := { 1..8 }\n"
48 "\t PHASE-SEG1 := { 1..8 }\n"
49 "\t PHASE-SEG2 := { 1..8 }\n"
50 "\t SJW := { 1..4 }\n"
51 "\t RESTART-MS := { 0 | NUMBER }\n"
5a204478
WG		 52 );
53}
54
561e650e 55static void usage(void)
56{
57 print_usage(stderr);
58}
59
5a204478
WG		 60static int get_float(float *val, const char *arg)
61{
62 float res;
63 char *ptr;
64
65 if (!arg || !*arg)
66 return -1;
67 res = strtof(arg, &ptr);
68 if (!ptr || ptr == arg || *ptr)
69 return -1;
70 *val = res;
71 return 0;
72}
73
74static void set_ctrlmode(char* name, char *arg,
75 struct can_ctrlmode *cm, __u32 flags)
76{
77 if (strcmp(arg, "on") == 0) {
78 cm->flags |= flags;
79 } else if (strcmp(arg, "off") != 0) {
80 fprintf(stderr,
14645ec2
KR		 81 "Error: argument of \"%s\" must be \"on\" or \"off\", not \"%s\"\n",
82 name, arg);
5a204478
WG		 83 exit(-1);
84 }
85 cm->mask |= flags;
86}
87
88static void print_ctrlmode(FILE *f, __u32 cm)
89{
90 fprintf(f, "<");
91#define _PF(cmflag, cmname) \
92 if (cm & cmflag) { \
93 cm &= ~cmflag; \
94 fprintf(f, "%s%s", cmname, cm ? "," : ""); \
95 }
96 _PF(CAN_CTRLMODE_LOOPBACK, "LOOPBACK");
97 _PF(CAN_CTRLMODE_LISTENONLY, "LISTEN-ONLY");
98 _PF(CAN_CTRLMODE_3_SAMPLES, "TRIPLE-SAMPLING");
8a517946
WG		 99 _PF(CAN_CTRLMODE_ONE_SHOT, "ONE-SHOT");
100 _PF(CAN_CTRLMODE_BERR_REPORTING, "BERR-REPORTING");
2bfe0470 101 _PF(CAN_CTRLMODE_FD, "FD");
5a204478
WG		 102#undef _PF
103 if (cm)
104 fprintf(f, "%x", cm);
105 fprintf(f, "> ");
106}
107
108static int can_parse_opt(struct link_util *lu, int argc, char **argv,
109 struct nlmsghdr *n)
110{
2bfe0470 111 struct can_bittiming bt, dbt;
5a204478
WG		 112 struct can_ctrlmode cm = {0, 0};
113
114 memset(&bt, 0, sizeof(bt));
2bfe0470 115 memset(&dbt, 0, sizeof(dbt));
5a204478
WG		 116 while (argc > 0) {
117 if (matches(*argv, "bitrate") == 0) {
118 NEXT_ARG();
119 if (get_u32(&bt.bitrate, *argv, 0))
120 invarg("invalid \"bitrate\" value\n", *argv);
121 } else if (matches(*argv, "sample-point") == 0) {
122 float sp;
123
124 NEXT_ARG();
125 if (get_float(&sp, *argv))
126 invarg("invalid \"sample-point\" value\n",
127 *argv);
128 bt.sample_point = (__u32)(sp * 1000);
129 } else if (matches(*argv, "tq") == 0) {
130 NEXT_ARG();
131 if (get_u32(&bt.tq, *argv, 0))
132 invarg("invalid \"tq\" value\n", *argv);
133 } else if (matches(*argv, "prop-seg") == 0) {
134 NEXT_ARG();
135 if (get_u32(&bt.prop_seg, *argv, 0))
136 invarg("invalid \"prop-seg\" value\n", *argv);
137 } else if (matches(*argv, "phase-seg1") == 0) {
138 NEXT_ARG();
139 if (get_u32(&bt.phase_seg1, *argv, 0))
140 invarg("invalid \"phase-seg1\" value\n", *argv);
141 } else if (matches(*argv, "phase-seg2") == 0) {
142 NEXT_ARG();
143 if (get_u32(&bt.phase_seg2, *argv, 0))
144 invarg("invalid \"phase-seg2\" value\n", *argv);
145 } else if (matches(*argv, "sjw") == 0) {
146 NEXT_ARG();
147 if (get_u32(&bt.sjw, *argv, 0))
148 invarg("invalid \"sjw\" value\n", *argv);
2bfe0470
OH		 149 } else if (matches(*argv, "dbitrate") == 0) {
150 NEXT_ARG();
151 if (get_u32(&dbt.bitrate, *argv, 0))
152 invarg("invalid \"dbitrate\" value\n", *argv);
153 } else if (matches(*argv, "dsample-point") == 0) {
154 float sp;
155
156 NEXT_ARG();
157 if (get_float(&sp, *argv))
158 invarg("invalid \"dsample-point\" value\n", *argv);
159 dbt.sample_point = (__u32)(sp * 1000);
160 } else if (matches(*argv, "dtq") == 0) {
161 NEXT_ARG();
162 if (get_u32(&dbt.tq, *argv, 0))
163 invarg("invalid \"dtq\" value\n", *argv);
164 } else if (matches(*argv, "dprop-seg") == 0) {
165 NEXT_ARG();
166 if (get_u32(&dbt.prop_seg, *argv, 0))
167 invarg("invalid \"dprop-seg\" value\n", *argv);
168 } else if (matches(*argv, "dphase-seg1") == 0) {
169 NEXT_ARG();
170 if (get_u32(&dbt.phase_seg1, *argv, 0))
171 invarg("invalid \"dphase-seg1\" value\n", *argv);
172 } else if (matches(*argv, "dphase-seg2") == 0) {
173 NEXT_ARG();
174 if (get_u32(&dbt.phase_seg2, *argv, 0))
175 invarg("invalid \"dphase-seg2\" value\n", *argv);
176 } else if (matches(*argv, "dsjw") == 0) {
177 NEXT_ARG();
178 if (get_u32(&dbt.sjw, *argv, 0))
179 invarg("invalid \"dsjw\" value\n", *argv);
5a204478
WG		 180 } else if (matches(*argv, "loopback") == 0) {
181 NEXT_ARG();
182 set_ctrlmode("loopback", *argv, &cm,
183 CAN_CTRLMODE_LOOPBACK);
184 } else if (matches(*argv, "listen-only") == 0) {
185 NEXT_ARG();
186 set_ctrlmode("listen-only", *argv, &cm,
187 CAN_CTRLMODE_LISTENONLY);
188 } else if (matches(*argv, "triple-sampling") == 0) {
189 NEXT_ARG();
190 set_ctrlmode("triple-sampling", *argv, &cm,
191 CAN_CTRLMODE_3_SAMPLES);
8a517946
WG		 192 } else if (matches(*argv, "one-shot") == 0) {
193 NEXT_ARG();
194 set_ctrlmode("one-shot", *argv, &cm,
195 CAN_CTRLMODE_ONE_SHOT);
196 } else if (matches(*argv, "berr-reporting") == 0) {
197 NEXT_ARG();
198 set_ctrlmode("berr-reporting", *argv, &cm,
199 CAN_CTRLMODE_BERR_REPORTING);
2bfe0470
OH		 200 } else if (matches(*argv, "fd") == 0) {
201 NEXT_ARG();
202 set_ctrlmode("fd", *argv, &cm,
203 CAN_CTRLMODE_FD);
5a204478
WG		 204 } else if (matches(*argv, "restart") == 0) {
205 __u32 val = 1;
206
207 addattr32(n, 1024, IFLA_CAN_RESTART, val);
208 } else if (matches(*argv, "restart-ms") == 0) {
209 __u32 val;
210
211 NEXT_ARG();
212 if (get_u32(&val, *argv, 0))
213 invarg("invalid \"restart-ms\" value\n", *argv);
214 addattr32(n, 1024, IFLA_CAN_RESTART_MS, val);
215 } else if (matches(*argv, "help") == 0) {
216 usage();
217 return -1;
218 } else {
14645ec2 219 fprintf(stderr, "can: unknown option \"%s\"\n", *argv);
5a204478
WG		 220 usage();
221 return -1;
222 }
223 argc--, argv++;
224 }
225
226 if (bt.bitrate || bt.tq)
227 addattr_l(n, 1024, IFLA_CAN_BITTIMING, &bt, sizeof(bt));
2bfe0470
OH		 228 if (dbt.bitrate || dbt.tq)
229 addattr_l(n, 1024, IFLA_CAN_DATA_BITTIMING, &dbt, sizeof(dbt));
5a204478
WG		 230 if (cm.mask)
231 addattr_l(n, 1024, IFLA_CAN_CTRLMODE, &cm, sizeof(cm));
232
233 return 0;
234}
235
236static const char *can_state_names[] = {
3bbff7df
OH		 237 [CAN_STATE_ERROR_ACTIVE] = "ERROR-ACTIVE",
238 [CAN_STATE_ERROR_WARNING] = "ERROR-WARNING",
239 [CAN_STATE_ERROR_PASSIVE] = "ERROR-PASSIVE",
240 [CAN_STATE_BUS_OFF] = "BUS-OFF",
241 [CAN_STATE_STOPPED] = "STOPPED",
242 [CAN_STATE_SLEEPING] = "SLEEPING"
5a204478
WG		 243};
244
245static void can_print_opt(struct link_util *lu, FILE *f, struct rtattr *tb[])
246{
247 if (!tb)
248 return;
249
250 if (tb[IFLA_CAN_CTRLMODE]) {
251 struct can_ctrlmode *cm = RTA_DATA(tb[IFLA_CAN_CTRLMODE]);
252
253 if (cm->flags)
254 print_ctrlmode(f, cm->flags);
255 }
256
257 if (tb[IFLA_CAN_STATE]) {
258 int *state = RTA_DATA(tb[IFLA_CAN_STATE]);
259
260 fprintf(f, "state %s ", *state <= CAN_STATE_MAX ?
261 can_state_names[*state] : "UNKNOWN");
262 }
263
8a517946
WG		 264 if (tb[IFLA_CAN_BERR_COUNTER]) {
265 struct can_berr_counter *bc =
266 RTA_DATA(tb[IFLA_CAN_BERR_COUNTER]);
267
268 fprintf(f, "(berr-counter tx %d rx %d) ", bc->txerr, bc->rxerr);
269 }
270
5a204478
WG		 271 if (tb[IFLA_CAN_RESTART_MS]) {
272 __u32 *restart_ms = RTA_DATA(tb[IFLA_CAN_RESTART_MS]);
273
274 fprintf(f, "restart-ms %d ", *restart_ms);
275 }
276
277 if (tb[IFLA_CAN_BITTIMING]) {
278 struct can_bittiming *bt = RTA_DATA(tb[IFLA_CAN_BITTIMING]);
279
3bbff7df 280 fprintf(f, "\n "
5a204478 281 "bitrate %d sample-point %.3f ",
3bbff7df
OH		 282 bt->bitrate, (float)bt->sample_point / 1000.);
283 fprintf(f, "\n "
5a204478
WG		 284 "tq %d prop-seg %d phase-seg1 %d phase-seg2 %d sjw %d",
285 bt->tq, bt->prop_seg, bt->phase_seg1, bt->phase_seg2,
286 bt->sjw);
287 }
288
289 if (tb[IFLA_CAN_BITTIMING_CONST]) {
290 struct can_bittiming_const *btc =
291 RTA_DATA(tb[IFLA_CAN_BITTIMING_CONST]);
292
3bbff7df 293 fprintf(f, "\n "
5a204478
WG		 294 "%s: tseg1 %d..%d tseg2 %d..%d "
295 "sjw 1..%d brp %d..%d brp-inc %d",
3bbff7df 296 btc->name, btc->tseg1_min, btc->tseg1_max,
5a204478
WG		 297 btc->tseg2_min, btc->tseg2_max, btc->sjw_max,
298 btc->brp_min, btc->brp_max, btc->brp_inc);
299 }
300
2bfe0470
OH		 301 if (tb[IFLA_CAN_DATA_BITTIMING]) {
302 struct can_bittiming *dbt =
303 RTA_DATA(tb[IFLA_CAN_DATA_BITTIMING]);
304
305 fprintf(f, "\n "
306 "dbitrate %d dsample-point %.3f ",
307 dbt->bitrate, (float)dbt->sample_point / 1000.);
308 fprintf(f, "\n "
309 "dtq %d dprop-seg %d dphase-seg1 %d "
310 "dphase-seg2 %d dsjw %d",
311 dbt->tq, dbt->prop_seg, dbt->phase_seg1,
312 dbt->phase_seg2, dbt->sjw);
313 }
314
315 if (tb[IFLA_CAN_DATA_BITTIMING_CONST]) {
316 struct can_bittiming_const *dbtc =
317 RTA_DATA(tb[IFLA_CAN_DATA_BITTIMING_CONST]);
318
319 fprintf(f, "\n "
320 "%s: dtseg1 %d..%d dtseg2 %d..%d "
321 "dsjw 1..%d dbrp %d..%d dbrp-inc %d",
322 dbtc->name, dbtc->tseg1_min, dbtc->tseg1_max,
323 dbtc->tseg2_min, dbtc->tseg2_max, dbtc->sjw_max,
324 dbtc->brp_min, dbtc->brp_max, dbtc->brp_inc);
325 }
326
5a204478
WG		 327 if (tb[IFLA_CAN_CLOCK]) {
328 struct can_clock *clock = RTA_DATA(tb[IFLA_CAN_CLOCK]);
329
3bbff7df 330 fprintf(f, "\n clock %d", clock->freq);
5a204478
WG		 331 }
332
333}
334
335static void can_print_xstats(struct link_util *lu,
336 FILE *f, struct rtattr *xstats)
337{
338 struct can_device_stats *stats;
339
340 if (xstats && RTA_PAYLOAD(xstats) == sizeof(*stats)) {
341 stats = RTA_DATA(xstats);
3bbff7df 342 fprintf(f, "\n "
5a204478
WG		 343 "re-started bus-errors arbit-lost "
344 "error-warn error-pass bus-off");
3bbff7df 345 fprintf(f, "\n %-10d %-10d %-10d %-10d %-10d %-10d",
5a204478
WG		 346 stats->restarts, stats->bus_error,
347 stats->arbitration_lost, stats->error_warning,
348 stats->error_passive, stats->bus_off);
349 }
350}
351
561e650e 352static void can_print_help(struct link_util *lu, int argc, char **argv,
353 FILE *f)
354{
355 print_usage(f);
356}
357
5a204478
WG		 358struct link_util can_link_util = {
359 .id = "can",
360 .maxattr = IFLA_CAN_MAX,
361 .parse_opt = can_parse_opt,
362 .print_opt = can_print_opt,
4806867a 363 .print_xstats = can_print_xstats,
561e650e 364 .print_help = can_print_help,
5a204478 365};
Upstream mirror of iproute2