Wolfgang Grandegger | 5a20447 | 2009-05-12 11:42:50 +0200 | [diff] [blame] | 1 | /* |
| 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 | |
| 22 | static 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 Grandegger | 8a51794 | 2010-02-22 22:24:55 +0000 | [diff] [blame] | 33 | "\t[ one-shot { on | off } ]\n" |
| 34 | "\t[ berr-reporting { on | off } ]\n" |
Wolfgang Grandegger | 5a20447 | 2009-05-12 11:42:50 +0200 | [diff] [blame] | 35 | "\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 | |
| 50 | static 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 | |
| 64 | static 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 Reeuwijk | 14645ec | 2013-02-08 03:32:36 +0000 | [diff] [blame] | 71 | "Error: argument of \"%s\" must be \"on\" or \"off\", not \"%s\"\n", |
| 72 | name, arg); |
Wolfgang Grandegger | 5a20447 | 2009-05-12 11:42:50 +0200 | [diff] [blame] | 73 | exit(-1); |
| 74 | } |
| 75 | cm->mask |= flags; |
| 76 | } |
| 77 | |
| 78 | static 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 Grandegger | 8a51794 | 2010-02-22 22:24:55 +0000 | [diff] [blame] | 89 | _PF(CAN_CTRLMODE_ONE_SHOT, "ONE-SHOT"); |
| 90 | _PF(CAN_CTRLMODE_BERR_REPORTING, "BERR-REPORTING"); |
Wolfgang Grandegger | 5a20447 | 2009-05-12 11:42:50 +0200 | [diff] [blame] | 91 | #undef _PF |
| 92 | if (cm) |
| 93 | fprintf(f, "%x", cm); |
| 94 | fprintf(f, "> "); |
| 95 | } |
| 96 | |
| 97 | static 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 Grandegger | 8a51794 | 2010-02-22 22:24:55 +0000 | [diff] [blame] | 149 | } 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 Grandegger | 5a20447 | 2009-05-12 11:42:50 +0200 | [diff] [blame] | 157 | } 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 Reeuwijk | 14645ec | 2013-02-08 03:32:36 +0000 | [diff] [blame] | 172 | fprintf(stderr, "can: unknown option \"%s\"\n", *argv); |
Wolfgang Grandegger | 5a20447 | 2009-05-12 11:42:50 +0200 | [diff] [blame] | 173 | 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 | |
| 187 | static 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 | |
| 196 | static 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 Grandegger | 8a51794 | 2010-02-22 22:24:55 +0000 | [diff] [blame] | 215 | 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 Grandegger | 5a20447 | 2009-05-12 11:42:50 +0200 | [diff] [blame] | 222 | 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 | |
| 260 | static 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 | |
| 277 | struct 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 | }; |