]>
Commit | Line | Data |
---|---|---|
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 | 22 | static void print_usage(FILE *f) |
5a204478 | 23 | { |
561e650e | 24 | fprintf(f, |
5a204478 | 25 | "Usage: ip link set DEVICE type can\n" |
56f5daac SH |
26 | "\t[ bitrate BITRATE [ sample-point SAMPLE-POINT] ] |\n" |
27 | "\t[ tq TQ prop-seg PROP_SEG phase-seg1 PHASE-SEG1\n \t phase-seg2 PHASE-SEG2 [ sjw SJW ] ]\n" | |
5a204478 | 28 | "\n" |
56f5daac SH |
29 | "\t[ dbitrate BITRATE [ dsample-point SAMPLE-POINT] ] |\n" |
30 | "\t[ dtq TQ dprop-seg PROP_SEG dphase-seg1 PHASE-SEG1\n \t dphase-seg2 PHASE-SEG2 [ dsjw SJW ] ]\n" | |
2bfe0470 | 31 | "\n" |
3bbff7df OH |
32 | "\t[ loopback { on | off } ]\n" |
33 | "\t[ listen-only { on | off } ]\n" | |
34 | "\t[ triple-sampling { on | off } ]\n" | |
35 | "\t[ one-shot { on | off } ]\n" | |
36 | "\t[ berr-reporting { on | off } ]\n" | |
2bfe0470 | 37 | "\t[ fd { on | off } ]\n" |
82a307e8 | 38 | "\t[ fd-non-iso { on | off } ]\n" |
d26caee7 | 39 | "\t[ presume-ack { 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 | 55 | static void usage(void) |
56 | { | |
57 | print_usage(stderr); | |
58 | } | |
59 | ||
5a204478 WG |
60 | static 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 | ||
56f5daac | 74 | static void set_ctrlmode(char *name, char *arg, |
5a204478 WG |
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 | ||
88 | static 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"); |
82a307e8 | 102 | _PF(CAN_CTRLMODE_FD_NON_ISO, "FD-NON-ISO"); |
d26caee7 | 103 | _PF(CAN_CTRLMODE_PRESUME_ACK, "PRESUME-ACK"); |
5a204478 WG |
104 | #undef _PF |
105 | if (cm) | |
106 | fprintf(f, "%x", cm); | |
107 | fprintf(f, "> "); | |
108 | } | |
109 | ||
110 | static int can_parse_opt(struct link_util *lu, int argc, char **argv, | |
111 | struct nlmsghdr *n) | |
112 | { | |
2bfe0470 | 113 | struct can_bittiming bt, dbt; |
5a204478 WG |
114 | struct can_ctrlmode cm = {0, 0}; |
115 | ||
116 | memset(&bt, 0, sizeof(bt)); | |
2bfe0470 | 117 | memset(&dbt, 0, sizeof(dbt)); |
5a204478 WG |
118 | while (argc > 0) { |
119 | if (matches(*argv, "bitrate") == 0) { | |
120 | NEXT_ARG(); | |
121 | if (get_u32(&bt.bitrate, *argv, 0)) | |
122 | invarg("invalid \"bitrate\" value\n", *argv); | |
123 | } else if (matches(*argv, "sample-point") == 0) { | |
124 | float sp; | |
125 | ||
126 | NEXT_ARG(); | |
127 | if (get_float(&sp, *argv)) | |
128 | invarg("invalid \"sample-point\" value\n", | |
129 | *argv); | |
130 | bt.sample_point = (__u32)(sp * 1000); | |
131 | } else if (matches(*argv, "tq") == 0) { | |
132 | NEXT_ARG(); | |
133 | if (get_u32(&bt.tq, *argv, 0)) | |
134 | invarg("invalid \"tq\" value\n", *argv); | |
135 | } else if (matches(*argv, "prop-seg") == 0) { | |
136 | NEXT_ARG(); | |
137 | if (get_u32(&bt.prop_seg, *argv, 0)) | |
138 | invarg("invalid \"prop-seg\" value\n", *argv); | |
139 | } else if (matches(*argv, "phase-seg1") == 0) { | |
140 | NEXT_ARG(); | |
141 | if (get_u32(&bt.phase_seg1, *argv, 0)) | |
142 | invarg("invalid \"phase-seg1\" value\n", *argv); | |
143 | } else if (matches(*argv, "phase-seg2") == 0) { | |
144 | NEXT_ARG(); | |
145 | if (get_u32(&bt.phase_seg2, *argv, 0)) | |
146 | invarg("invalid \"phase-seg2\" value\n", *argv); | |
147 | } else if (matches(*argv, "sjw") == 0) { | |
148 | NEXT_ARG(); | |
149 | if (get_u32(&bt.sjw, *argv, 0)) | |
150 | invarg("invalid \"sjw\" value\n", *argv); | |
2bfe0470 OH |
151 | } else if (matches(*argv, "dbitrate") == 0) { |
152 | NEXT_ARG(); | |
153 | if (get_u32(&dbt.bitrate, *argv, 0)) | |
154 | invarg("invalid \"dbitrate\" value\n", *argv); | |
155 | } else if (matches(*argv, "dsample-point") == 0) { | |
156 | float sp; | |
157 | ||
158 | NEXT_ARG(); | |
159 | if (get_float(&sp, *argv)) | |
160 | invarg("invalid \"dsample-point\" value\n", *argv); | |
161 | dbt.sample_point = (__u32)(sp * 1000); | |
162 | } else if (matches(*argv, "dtq") == 0) { | |
163 | NEXT_ARG(); | |
164 | if (get_u32(&dbt.tq, *argv, 0)) | |
165 | invarg("invalid \"dtq\" value\n", *argv); | |
166 | } else if (matches(*argv, "dprop-seg") == 0) { | |
167 | NEXT_ARG(); | |
168 | if (get_u32(&dbt.prop_seg, *argv, 0)) | |
169 | invarg("invalid \"dprop-seg\" value\n", *argv); | |
170 | } else if (matches(*argv, "dphase-seg1") == 0) { | |
171 | NEXT_ARG(); | |
172 | if (get_u32(&dbt.phase_seg1, *argv, 0)) | |
173 | invarg("invalid \"dphase-seg1\" value\n", *argv); | |
174 | } else if (matches(*argv, "dphase-seg2") == 0) { | |
175 | NEXT_ARG(); | |
176 | if (get_u32(&dbt.phase_seg2, *argv, 0)) | |
177 | invarg("invalid \"dphase-seg2\" value\n", *argv); | |
178 | } else if (matches(*argv, "dsjw") == 0) { | |
179 | NEXT_ARG(); | |
180 | if (get_u32(&dbt.sjw, *argv, 0)) | |
181 | invarg("invalid \"dsjw\" value\n", *argv); | |
5a204478 WG |
182 | } else if (matches(*argv, "loopback") == 0) { |
183 | NEXT_ARG(); | |
184 | set_ctrlmode("loopback", *argv, &cm, | |
185 | CAN_CTRLMODE_LOOPBACK); | |
186 | } else if (matches(*argv, "listen-only") == 0) { | |
187 | NEXT_ARG(); | |
188 | set_ctrlmode("listen-only", *argv, &cm, | |
189 | CAN_CTRLMODE_LISTENONLY); | |
190 | } else if (matches(*argv, "triple-sampling") == 0) { | |
191 | NEXT_ARG(); | |
192 | set_ctrlmode("triple-sampling", *argv, &cm, | |
193 | CAN_CTRLMODE_3_SAMPLES); | |
8a517946 WG |
194 | } else if (matches(*argv, "one-shot") == 0) { |
195 | NEXT_ARG(); | |
196 | set_ctrlmode("one-shot", *argv, &cm, | |
197 | CAN_CTRLMODE_ONE_SHOT); | |
198 | } else if (matches(*argv, "berr-reporting") == 0) { | |
199 | NEXT_ARG(); | |
200 | set_ctrlmode("berr-reporting", *argv, &cm, | |
201 | CAN_CTRLMODE_BERR_REPORTING); | |
2bfe0470 OH |
202 | } else if (matches(*argv, "fd") == 0) { |
203 | NEXT_ARG(); | |
204 | set_ctrlmode("fd", *argv, &cm, | |
205 | CAN_CTRLMODE_FD); | |
82a307e8 OH |
206 | } else if (matches(*argv, "fd-non-iso") == 0) { |
207 | NEXT_ARG(); | |
208 | set_ctrlmode("fd-non-iso", *argv, &cm, | |
209 | CAN_CTRLMODE_FD_NON_ISO); | |
d26caee7 NEB |
210 | } else if (matches(*argv, "presume-ack") == 0) { |
211 | NEXT_ARG(); | |
212 | set_ctrlmode("presume-ack", *argv, &cm, | |
213 | CAN_CTRLMODE_PRESUME_ACK); | |
5a204478 WG |
214 | } else if (matches(*argv, "restart") == 0) { |
215 | __u32 val = 1; | |
216 | ||
217 | addattr32(n, 1024, IFLA_CAN_RESTART, val); | |
218 | } else if (matches(*argv, "restart-ms") == 0) { | |
219 | __u32 val; | |
220 | ||
221 | NEXT_ARG(); | |
222 | if (get_u32(&val, *argv, 0)) | |
223 | invarg("invalid \"restart-ms\" value\n", *argv); | |
224 | addattr32(n, 1024, IFLA_CAN_RESTART_MS, val); | |
225 | } else if (matches(*argv, "help") == 0) { | |
226 | usage(); | |
227 | return -1; | |
228 | } else { | |
14645ec2 | 229 | fprintf(stderr, "can: unknown option \"%s\"\n", *argv); |
5a204478 WG |
230 | usage(); |
231 | return -1; | |
232 | } | |
233 | argc--, argv++; | |
234 | } | |
235 | ||
236 | if (bt.bitrate || bt.tq) | |
237 | addattr_l(n, 1024, IFLA_CAN_BITTIMING, &bt, sizeof(bt)); | |
2bfe0470 OH |
238 | if (dbt.bitrate || dbt.tq) |
239 | addattr_l(n, 1024, IFLA_CAN_DATA_BITTIMING, &dbt, sizeof(dbt)); | |
5a204478 WG |
240 | if (cm.mask) |
241 | addattr_l(n, 1024, IFLA_CAN_CTRLMODE, &cm, sizeof(cm)); | |
242 | ||
243 | return 0; | |
244 | } | |
245 | ||
246 | static const char *can_state_names[] = { | |
3bbff7df OH |
247 | [CAN_STATE_ERROR_ACTIVE] = "ERROR-ACTIVE", |
248 | [CAN_STATE_ERROR_WARNING] = "ERROR-WARNING", | |
249 | [CAN_STATE_ERROR_PASSIVE] = "ERROR-PASSIVE", | |
250 | [CAN_STATE_BUS_OFF] = "BUS-OFF", | |
251 | [CAN_STATE_STOPPED] = "STOPPED", | |
252 | [CAN_STATE_SLEEPING] = "SLEEPING" | |
5a204478 WG |
253 | }; |
254 | ||
255 | static void can_print_opt(struct link_util *lu, FILE *f, struct rtattr *tb[]) | |
256 | { | |
257 | if (!tb) | |
258 | return; | |
259 | ||
260 | if (tb[IFLA_CAN_CTRLMODE]) { | |
261 | struct can_ctrlmode *cm = RTA_DATA(tb[IFLA_CAN_CTRLMODE]); | |
262 | ||
263 | if (cm->flags) | |
264 | print_ctrlmode(f, cm->flags); | |
265 | } | |
266 | ||
267 | if (tb[IFLA_CAN_STATE]) { | |
268 | int *state = RTA_DATA(tb[IFLA_CAN_STATE]); | |
269 | ||
270 | fprintf(f, "state %s ", *state <= CAN_STATE_MAX ? | |
271 | can_state_names[*state] : "UNKNOWN"); | |
272 | } | |
273 | ||
8a517946 WG |
274 | if (tb[IFLA_CAN_BERR_COUNTER]) { |
275 | struct can_berr_counter *bc = | |
276 | RTA_DATA(tb[IFLA_CAN_BERR_COUNTER]); | |
277 | ||
278 | fprintf(f, "(berr-counter tx %d rx %d) ", bc->txerr, bc->rxerr); | |
279 | } | |
280 | ||
5a204478 WG |
281 | if (tb[IFLA_CAN_RESTART_MS]) { |
282 | __u32 *restart_ms = RTA_DATA(tb[IFLA_CAN_RESTART_MS]); | |
283 | ||
284 | fprintf(f, "restart-ms %d ", *restart_ms); | |
285 | } | |
286 | ||
287 | if (tb[IFLA_CAN_BITTIMING]) { | |
288 | struct can_bittiming *bt = RTA_DATA(tb[IFLA_CAN_BITTIMING]); | |
289 | ||
56f5daac | 290 | fprintf(f, "\n bitrate %d sample-point %.3f ", |
3bbff7df | 291 | bt->bitrate, (float)bt->sample_point / 1000.); |
56f5daac | 292 | fprintf(f, "\n tq %d prop-seg %d phase-seg1 %d phase-seg2 %d sjw %d", |
5a204478 WG |
293 | bt->tq, bt->prop_seg, bt->phase_seg1, bt->phase_seg2, |
294 | bt->sjw); | |
295 | } | |
296 | ||
297 | if (tb[IFLA_CAN_BITTIMING_CONST]) { | |
298 | struct can_bittiming_const *btc = | |
299 | RTA_DATA(tb[IFLA_CAN_BITTIMING_CONST]); | |
300 | ||
56f5daac | 301 | fprintf(f, "\n %s: tseg1 %d..%d tseg2 %d..%d " |
5a204478 | 302 | "sjw 1..%d brp %d..%d brp-inc %d", |
3bbff7df | 303 | btc->name, btc->tseg1_min, btc->tseg1_max, |
5a204478 WG |
304 | btc->tseg2_min, btc->tseg2_max, btc->sjw_max, |
305 | btc->brp_min, btc->brp_max, btc->brp_inc); | |
306 | } | |
307 | ||
2bfe0470 OH |
308 | if (tb[IFLA_CAN_DATA_BITTIMING]) { |
309 | struct can_bittiming *dbt = | |
310 | RTA_DATA(tb[IFLA_CAN_DATA_BITTIMING]); | |
311 | ||
56f5daac | 312 | fprintf(f, "\n dbitrate %d dsample-point %.3f ", |
2bfe0470 | 313 | dbt->bitrate, (float)dbt->sample_point / 1000.); |
56f5daac | 314 | fprintf(f, "\n dtq %d dprop-seg %d dphase-seg1 %d " |
2bfe0470 OH |
315 | "dphase-seg2 %d dsjw %d", |
316 | dbt->tq, dbt->prop_seg, dbt->phase_seg1, | |
317 | dbt->phase_seg2, dbt->sjw); | |
318 | } | |
319 | ||
320 | if (tb[IFLA_CAN_DATA_BITTIMING_CONST]) { | |
321 | struct can_bittiming_const *dbtc = | |
322 | RTA_DATA(tb[IFLA_CAN_DATA_BITTIMING_CONST]); | |
323 | ||
56f5daac | 324 | fprintf(f, "\n %s: dtseg1 %d..%d dtseg2 %d..%d " |
2bfe0470 OH |
325 | "dsjw 1..%d dbrp %d..%d dbrp-inc %d", |
326 | dbtc->name, dbtc->tseg1_min, dbtc->tseg1_max, | |
327 | dbtc->tseg2_min, dbtc->tseg2_max, dbtc->sjw_max, | |
328 | dbtc->brp_min, dbtc->brp_max, dbtc->brp_inc); | |
329 | } | |
330 | ||
5a204478 WG |
331 | if (tb[IFLA_CAN_CLOCK]) { |
332 | struct can_clock *clock = RTA_DATA(tb[IFLA_CAN_CLOCK]); | |
333 | ||
3bbff7df | 334 | fprintf(f, "\n clock %d", clock->freq); |
5a204478 WG |
335 | } |
336 | ||
337 | } | |
338 | ||
339 | static void can_print_xstats(struct link_util *lu, | |
340 | FILE *f, struct rtattr *xstats) | |
341 | { | |
342 | struct can_device_stats *stats; | |
343 | ||
344 | if (xstats && RTA_PAYLOAD(xstats) == sizeof(*stats)) { | |
345 | stats = RTA_DATA(xstats); | |
56f5daac | 346 | fprintf(f, "\n re-started bus-errors arbit-lost " |
5a204478 | 347 | "error-warn error-pass bus-off"); |
3bbff7df | 348 | fprintf(f, "\n %-10d %-10d %-10d %-10d %-10d %-10d", |
5a204478 WG |
349 | stats->restarts, stats->bus_error, |
350 | stats->arbitration_lost, stats->error_warning, | |
351 | stats->error_passive, stats->bus_off); | |
352 | } | |
353 | } | |
354 | ||
561e650e | 355 | static void can_print_help(struct link_util *lu, int argc, char **argv, |
356 | FILE *f) | |
357 | { | |
358 | print_usage(f); | |
359 | } | |
360 | ||
5a204478 WG |
361 | struct link_util can_link_util = { |
362 | .id = "can", | |
363 | .maxattr = IFLA_CAN_MAX, | |
364 | .parse_opt = can_parse_opt, | |
365 | .print_opt = can_print_opt, | |
4806867a | 366 | .print_xstats = can_print_xstats, |
561e650e | 367 | .print_help = can_print_help, |
5a204478 | 368 | }; |