blob: 5674358845e4ce4378482433bee7292c4e4148bc [file] [log] [blame]
Wolfgang Grandegger5a204472009-05-12 11:42:50 +02001/*
2 * iplink_can.c CAN device support
3 *
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.
8 *
9 * Authors: Wolfgang Grandegger <wg@grandegger.com>
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
22static void usage(void)
23{
24 fprintf(stderr,
25 "Usage: ip link set DEVICE type can\n"
26 "\t[ bitrate BITRATE [ sample-point SAMPLE-POINT] ] | \n"
27 "\t[ tq TQ prop-seg PROP_SEG phase-seg1 PHASE-SEG1\n "
28 "\t phase-seg2 PHASE-SEG2 [ sjw SJW ] ]\n"
29 "\n"
30 "\t[ loopback { on | off } ]\n"
31 "\t[ listen-only { on | off } ]\n"
32 "\t[ triple-sampling { on | off } ]\n"
Wolfgang Grandegger8a517942010-02-22 22:24:55 +000033 "\t[ one-shot { on | off } ]\n"
34 "\t[ berr-reporting { on | off } ]\n"
Wolfgang Grandegger5a204472009-05-12 11:42:50 +020035 "\n"
36 "\t[ restart-ms TIME-MS ]\n"
37 "\t[ restart ]\n"
38 "\n"
39 "\tWhere: BITRATE := { 1..1000000 }\n"
40 "\t SAMPLE-POINT := { 0.000..0.999 }\n"
41 "\t TQ := { NUMBER }\n"
42 "\t PROP-SEG := { 1..8 }\n"
43 "\t PHASE-SEG1 := { 1..8 }\n"
44 "\t PHASE-SEG2 := { 1..8 }\n"
45 "\t SJW := { 1..4 }\n"
46 "\t RESTART-MS := { 0 | NUMBER }\n"
47 );
48}
49
50static int get_float(float *val, const char *arg)
51{
52 float res;
53 char *ptr;
54
55 if (!arg || !*arg)
56 return -1;
57 res = strtof(arg, &ptr);
58 if (!ptr || ptr == arg || *ptr)
59 return -1;
60 *val = res;
61 return 0;
62}
63
64static void set_ctrlmode(char* name, char *arg,
65 struct can_ctrlmode *cm, __u32 flags)
66{
67 if (strcmp(arg, "on") == 0) {
68 cm->flags |= flags;
69 } else if (strcmp(arg, "off") != 0) {
70 fprintf(stderr,
Kees van Reeuwijk14645ec2013-02-08 03:32:36 +000071 "Error: argument of \"%s\" must be \"on\" or \"off\", not \"%s\"\n",
72 name, arg);
Wolfgang Grandegger5a204472009-05-12 11:42:50 +020073 exit(-1);
74 }
75 cm->mask |= flags;
76}
77
78static void print_ctrlmode(FILE *f, __u32 cm)
79{
80 fprintf(f, "<");
81#define _PF(cmflag, cmname) \
82 if (cm & cmflag) { \
83 cm &= ~cmflag; \
84 fprintf(f, "%s%s", cmname, cm ? "," : ""); \
85 }
86 _PF(CAN_CTRLMODE_LOOPBACK, "LOOPBACK");
87 _PF(CAN_CTRLMODE_LISTENONLY, "LISTEN-ONLY");
88 _PF(CAN_CTRLMODE_3_SAMPLES, "TRIPLE-SAMPLING");
Wolfgang Grandegger8a517942010-02-22 22:24:55 +000089 _PF(CAN_CTRLMODE_ONE_SHOT, "ONE-SHOT");
90 _PF(CAN_CTRLMODE_BERR_REPORTING, "BERR-REPORTING");
Wolfgang Grandegger5a204472009-05-12 11:42:50 +020091#undef _PF
92 if (cm)
93 fprintf(f, "%x", cm);
94 fprintf(f, "> ");
95}
96
97static int can_parse_opt(struct link_util *lu, int argc, char **argv,
98 struct nlmsghdr *n)
99{
100 struct can_bittiming bt;
101 struct can_ctrlmode cm = {0, 0};
102
103 memset(&bt, 0, sizeof(bt));
104 while (argc > 0) {
105 if (matches(*argv, "bitrate") == 0) {
106 NEXT_ARG();
107 if (get_u32(&bt.bitrate, *argv, 0))
108 invarg("invalid \"bitrate\" value\n", *argv);
109 } else if (matches(*argv, "sample-point") == 0) {
110 float sp;
111
112 NEXT_ARG();
113 if (get_float(&sp, *argv))
114 invarg("invalid \"sample-point\" value\n",
115 *argv);
116 bt.sample_point = (__u32)(sp * 1000);
117 } else if (matches(*argv, "tq") == 0) {
118 NEXT_ARG();
119 if (get_u32(&bt.tq, *argv, 0))
120 invarg("invalid \"tq\" value\n", *argv);
121 } else if (matches(*argv, "prop-seg") == 0) {
122 NEXT_ARG();
123 if (get_u32(&bt.prop_seg, *argv, 0))
124 invarg("invalid \"prop-seg\" value\n", *argv);
125 } else if (matches(*argv, "phase-seg1") == 0) {
126 NEXT_ARG();
127 if (get_u32(&bt.phase_seg1, *argv, 0))
128 invarg("invalid \"phase-seg1\" value\n", *argv);
129 } else if (matches(*argv, "phase-seg2") == 0) {
130 NEXT_ARG();
131 if (get_u32(&bt.phase_seg2, *argv, 0))
132 invarg("invalid \"phase-seg2\" value\n", *argv);
133 } else if (matches(*argv, "sjw") == 0) {
134 NEXT_ARG();
135 if (get_u32(&bt.sjw, *argv, 0))
136 invarg("invalid \"sjw\" value\n", *argv);
137 } else if (matches(*argv, "loopback") == 0) {
138 NEXT_ARG();
139 set_ctrlmode("loopback", *argv, &cm,
140 CAN_CTRLMODE_LOOPBACK);
141 } else if (matches(*argv, "listen-only") == 0) {
142 NEXT_ARG();
143 set_ctrlmode("listen-only", *argv, &cm,
144 CAN_CTRLMODE_LISTENONLY);
145 } else if (matches(*argv, "triple-sampling") == 0) {
146 NEXT_ARG();
147 set_ctrlmode("triple-sampling", *argv, &cm,
148 CAN_CTRLMODE_3_SAMPLES);
Wolfgang Grandegger8a517942010-02-22 22:24:55 +0000149 } else if (matches(*argv, "one-shot") == 0) {
150 NEXT_ARG();
151 set_ctrlmode("one-shot", *argv, &cm,
152 CAN_CTRLMODE_ONE_SHOT);
153 } else if (matches(*argv, "berr-reporting") == 0) {
154 NEXT_ARG();
155 set_ctrlmode("berr-reporting", *argv, &cm,
156 CAN_CTRLMODE_BERR_REPORTING);
Wolfgang Grandegger5a204472009-05-12 11:42:50 +0200157 } else if (matches(*argv, "restart") == 0) {
158 __u32 val = 1;
159
160 addattr32(n, 1024, IFLA_CAN_RESTART, val);
161 } else if (matches(*argv, "restart-ms") == 0) {
162 __u32 val;
163
164 NEXT_ARG();
165 if (get_u32(&val, *argv, 0))
166 invarg("invalid \"restart-ms\" value\n", *argv);
167 addattr32(n, 1024, IFLA_CAN_RESTART_MS, val);
168 } else if (matches(*argv, "help") == 0) {
169 usage();
170 return -1;
171 } else {
Kees van Reeuwijk14645ec2013-02-08 03:32:36 +0000172 fprintf(stderr, "can: unknown option \"%s\"\n", *argv);
Wolfgang Grandegger5a204472009-05-12 11:42:50 +0200173 usage();
174 return -1;
175 }
176 argc--, argv++;
177 }
178
179 if (bt.bitrate || bt.tq)
180 addattr_l(n, 1024, IFLA_CAN_BITTIMING, &bt, sizeof(bt));
181 if (cm.mask)
182 addattr_l(n, 1024, IFLA_CAN_CTRLMODE, &cm, sizeof(cm));
183
184 return 0;
185}
186
187static const char *can_state_names[] = {
188 [CAN_STATE_ERROR_ACTIVE] = "ERROR-ACTIVE",
189 [CAN_STATE_ERROR_WARNING] = "ERROR-WARNING",
190 [CAN_STATE_ERROR_PASSIVE] = "ERROR-PASSIVE",
191 [CAN_STATE_BUS_OFF] = "BUS-OFF",
192 [CAN_STATE_STOPPED] = "STOPPED",
193 [CAN_STATE_SLEEPING] = "SLEEPING"
194};
195
196static void can_print_opt(struct link_util *lu, FILE *f, struct rtattr *tb[])
197{
198 if (!tb)
199 return;
200
201 if (tb[IFLA_CAN_CTRLMODE]) {
202 struct can_ctrlmode *cm = RTA_DATA(tb[IFLA_CAN_CTRLMODE]);
203
204 if (cm->flags)
205 print_ctrlmode(f, cm->flags);
206 }
207
208 if (tb[IFLA_CAN_STATE]) {
209 int *state = RTA_DATA(tb[IFLA_CAN_STATE]);
210
211 fprintf(f, "state %s ", *state <= CAN_STATE_MAX ?
212 can_state_names[*state] : "UNKNOWN");
213 }
214
Wolfgang Grandegger8a517942010-02-22 22:24:55 +0000215 if (tb[IFLA_CAN_BERR_COUNTER]) {
216 struct can_berr_counter *bc =
217 RTA_DATA(tb[IFLA_CAN_BERR_COUNTER]);
218
219 fprintf(f, "(berr-counter tx %d rx %d) ", bc->txerr, bc->rxerr);
220 }
221
Wolfgang Grandegger5a204472009-05-12 11:42:50 +0200222 if (tb[IFLA_CAN_RESTART_MS]) {
223 __u32 *restart_ms = RTA_DATA(tb[IFLA_CAN_RESTART_MS]);
224
225 fprintf(f, "restart-ms %d ", *restart_ms);
226 }
227
228 if (tb[IFLA_CAN_BITTIMING]) {
229 struct can_bittiming *bt = RTA_DATA(tb[IFLA_CAN_BITTIMING]);
230
231 fprintf(f, "\n "
232 "bitrate %d sample-point %.3f ",
233 bt->bitrate, (float)bt->sample_point / 1000.);
234 fprintf(f, "\n "
235 "tq %d prop-seg %d phase-seg1 %d phase-seg2 %d sjw %d",
236 bt->tq, bt->prop_seg, bt->phase_seg1, bt->phase_seg2,
237 bt->sjw);
238 }
239
240 if (tb[IFLA_CAN_BITTIMING_CONST]) {
241 struct can_bittiming_const *btc =
242 RTA_DATA(tb[IFLA_CAN_BITTIMING_CONST]);
243
244 fprintf(f, "\n "
245 "%s: tseg1 %d..%d tseg2 %d..%d "
246 "sjw 1..%d brp %d..%d brp-inc %d",
247 btc->name, btc->tseg1_min, btc->tseg1_max,
248 btc->tseg2_min, btc->tseg2_max, btc->sjw_max,
249 btc->brp_min, btc->brp_max, btc->brp_inc);
250 }
251
252 if (tb[IFLA_CAN_CLOCK]) {
253 struct can_clock *clock = RTA_DATA(tb[IFLA_CAN_CLOCK]);
254
255 fprintf(f, "\n clock %d", clock->freq);
256 }
257
258}
259
260static void can_print_xstats(struct link_util *lu,
261 FILE *f, struct rtattr *xstats)
262{
263 struct can_device_stats *stats;
264
265 if (xstats && RTA_PAYLOAD(xstats) == sizeof(*stats)) {
266 stats = RTA_DATA(xstats);
267 fprintf(f, "\n "
268 "re-started bus-errors arbit-lost "
269 "error-warn error-pass bus-off");
270 fprintf(f, "\n %-10d %-10d %-10d %-10d %-10d %-10d",
271 stats->restarts, stats->bus_error,
272 stats->arbitration_lost, stats->error_warning,
273 stats->error_passive, stats->bus_off);
274 }
275}
276
277struct link_util can_link_util = {
278 .id = "can",
279 .maxattr = IFLA_CAN_MAX,
280 .parse_opt = can_parse_opt,
281 .print_opt = can_print_opt,
282 .print_xstats = can_print_xstats,
283};