diff --git a/usr.sbin/i2c/i2c.c b/usr.sbin/i2c/i2c.c index ef0ca0e8fda5..099418a5715c 100644 --- a/usr.sbin/i2c/i2c.c +++ b/usr.sbin/i2c/i2c.c @@ -1,696 +1,696 @@ /*- * SPDX-License-Identifier: BSD-2-Clause-FreeBSD * * Copyright (C) 2008-2009 Semihalf, Michal Hajduk and Bartlomiej Sieka * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. */ #include __FBSDID("$FreeBSD$"); #include #include #include #include #include #include #include #include #include #include #include #include #include #define I2C_DEV "/dev/iic0" #define I2C_MODE_NOTSET 0 #define I2C_MODE_NONE 1 #define I2C_MODE_STOP_START 2 #define I2C_MODE_REPEATED_START 3 #define I2C_MODE_TRANSFER 4 struct options { const char *width; unsigned count; int verbose; int binary; const char *skip; int mode; char dir; uint32_t addr; uint32_t off; uint8_t off_buf[2]; size_t off_len; }; __dead2 static void usage(const char *msg) { if (msg != NULL) fprintf(stderr, "%s\n", msg); fprintf(stderr, "usage: %s -a addr [-f device] [-d [r|w]] [-o offset] " "[-w [0|8|16|16LE|16BE]] [-c count] [-m [tr|ss|rs|no]] [-b] [-v]\n", getprogname()); fprintf(stderr, " %s -s [-f device] [-n skip_addr] -v\n", getprogname()); fprintf(stderr, " %s -r [-f device] -v\n", getprogname()); exit(EX_USAGE); } static int i2c_do_stop(int fd) { int i; i = ioctl(fd, I2CSTOP); if (i < 0) fprintf(stderr, "ioctl: error sending stop condition: %s\n", strerror(errno)); return (i); } static int i2c_do_start(int fd, struct iiccmd *cmd) { int i; i = ioctl(fd, I2CSTART, cmd); if (i < 0) fprintf(stderr, "ioctl: error sending start condition: %s\n", strerror(errno)); return (i); } static int i2c_do_repeatstart(int fd, struct iiccmd *cmd) { int i; i = ioctl(fd, I2CRPTSTART, cmd); if (i < 0) fprintf(stderr, "ioctl: error sending repeated start: %s\n", strerror(errno)); return (i); } static int i2c_do_write(int fd, struct iiccmd *cmd) { int i; i = ioctl(fd, I2CWRITE, cmd); if (i < 0) fprintf(stderr, "ioctl: error writing: %s\n", strerror(errno)); return (i); } static int i2c_do_read(int fd, struct iiccmd *cmd) { int i; i = ioctl(fd, I2CREAD, cmd); if (i < 0) fprintf(stderr, "ioctl: error reading: %s\n", strerror(errno)); return (i); } static int i2c_do_reset(int fd) { struct iiccmd cmd; int i; memset(&cmd, 0, sizeof cmd); i = ioctl(fd, I2CRSTCARD, &cmd); if (i < 0) fprintf(stderr, "ioctl: error resetting controller: %s\n", strerror(errno)); return (i); } static void parse_skip(const char *skip, char blacklist[128]) { const char *p; unsigned x, y; for (p = skip; *p != '\0';) { if (*p == '0' && p[1] == 'x') p += 2; if (!isxdigit(*p)) usage("Bad -n argument, expected (first) hex-digit"); x = digittoint(*p++) << 4; if (!isxdigit(*p)) usage("Bad -n argument, expected (second) hex-digit"); x |= digittoint(*p++); if (x == 0 || x > 0x7f) usage("Bad -n argument, (01..7f)"); if (*p == ':' || *p == ',' || *p == '\0') { blacklist[x] = 1; if (*p != '\0') p++; continue; } if (*p == '-') { p++; } else if (*p == '.' && p[1] == '.') { p += 2; } else { usage("Bad -n argument, ([:|,|..|-])"); } if (*p == '0' && p[1] == 'x') p += 2; if (!isxdigit(*p)) usage("Bad -n argument, expected (first) hex-digit"); y = digittoint(*p++) << 4; if (!isxdigit(*p)) usage("Bad -n argument, expected (second) hex-digit"); y |= digittoint(*p++); if (y == 0 || y > 0x7f) usage("Bad -n argument, (01..7f)"); if (y < x) usage("Bad -n argument, (end < start)"); for (;x <= y; x++) blacklist[x] = 1; if (*p == ':' || *p == ',') p++; } } static int scan_bus(const char *dev, int fd, const char *skip, int verbose) { struct iiccmd cmd; struct iic_msg rdmsg; struct iic_rdwr_data rdwrdata; int error; unsigned u; int num_found = 0, use_read_xfer; uint8_t rdbyte; char blacklist[128]; const char *sep = ""; memset(blacklist, 0, sizeof blacklist); if (skip != NULL) parse_skip(skip, blacklist); for (use_read_xfer = 0; use_read_xfer < 2; use_read_xfer++) { for (u = 1; u < 127; u++) { if (blacklist[u]) continue; cmd.slave = u << 1; cmd.last = 1; cmd.count = 0; if (i2c_do_reset(fd)) return (EX_NOINPUT); if (use_read_xfer) { rdmsg.buf = &rdbyte; rdmsg.len = 1; rdmsg.flags = IIC_M_RD; rdmsg.slave = u << 1; rdwrdata.msgs = &rdmsg; rdwrdata.nmsgs = 1; error = ioctl(fd, I2CRDWR, &rdwrdata); } else { error = ioctl(fd, I2CSTART, &cmd); if (errno == ENODEV || errno == EOPNOTSUPP) break; /* Try reads instead */ (void)ioctl(fd, I2CSTOP); } if (error == 0) { if (!num_found++ && verbose) { fprintf(stderr, "Scanning I2C devices on %s:\n", dev); } printf("%s%02x", sep, u); sep = " "; } } if (num_found > 0) break; if (verbose && !use_read_xfer) fprintf(stderr, "Hardware may not support START/STOP scanning; " "trying less-reliable read method.\n"); } if (num_found == 0 && verbose) printf(""); printf("\n"); return (i2c_do_reset(fd)); } static int reset_bus(const char *dev, int fd, int verbose) { if (verbose) fprintf(stderr, "Resetting I2C controller on %s\n", dev); return (i2c_do_reset(fd)); } static const char * -encode_offset(const char *width, unsigned address, uint8_t *dst, size_t *len) +encode_offset(const char *width, unsigned offset, uint8_t *dst, size_t *len) { if (!strcmp(width, "0")) { *len = 0; return (NULL); } if (!strcmp(width, "8")) { - if (address > 0xff) - return ("Invalid 8-bit address\n"); - *dst = address; + if (offset > 0xff) + return ("Invalid 8-bit offset\n"); + *dst = offset; *len = 1; return (NULL); } - if (address > 0xffff) - return ("Invalid 16-bit address\n"); + if (offset > 0xffff) + return ("Invalid 16-bit offset\n"); if (!strcmp(width, "16LE") || !strcmp(width, "16")) { - le16enc(dst, address); + le16enc(dst, offset); *len = 2; return (NULL); } if (!strcmp(width, "16BE")) { - be16enc(dst, address); + be16enc(dst, offset); *len = 2; return (NULL); } return ("Invalid offset width, must be: 0|8|16|16LE|16BE\n"); } static int write_offset(int fd, struct options i2c_opt, struct iiccmd *cmd) { if (i2c_opt.off_len > 0) { cmd->count = i2c_opt.off_len; cmd->buf = (void*)i2c_opt.off_buf; return (i2c_do_write(fd, cmd)); } return (0); } static int i2c_write(int fd, struct options i2c_opt, uint8_t *i2c_buf) { struct iiccmd cmd; char buf[i2c_opt.off_len + i2c_opt.count]; memset(&cmd, 0, sizeof(cmd)); cmd.slave = i2c_opt.addr; if (i2c_do_start(fd, &cmd)) return (i2c_do_stop(fd) | 1); switch(i2c_opt.mode) { case I2C_MODE_STOP_START: if (write_offset(fd, i2c_opt, &cmd)) return (i2c_do_stop(fd) | 1); if (i2c_do_stop(fd)) return (1); if (i2c_do_start(fd, &cmd)) return (i2c_do_stop(fd) | 1); /* * Write the data */ cmd.count = i2c_opt.count; cmd.buf = (void*)i2c_buf; cmd.last = 0; if (i2c_do_write(fd, &cmd)) return (i2c_do_stop(fd) | 1); break; case I2C_MODE_REPEATED_START: if (write_offset(fd, i2c_opt, &cmd)) return (i2c_do_stop(fd) | 1); if (i2c_do_repeatstart(fd, &cmd)) return (i2c_do_stop(fd) | 1); /* * Write the data */ cmd.count = i2c_opt.count; cmd.buf = (void*)i2c_buf; cmd.last = 0; if (i2c_do_write(fd, &cmd)) return (i2c_do_stop(fd) | 1); break; case I2C_MODE_NONE: /* fall through */ default: memcpy(buf, i2c_opt.off_buf, i2c_opt.off_len); memcpy(buf + i2c_opt.off_len, i2c_buf, i2c_opt.count); /* * Write offset and data */ cmd.count = i2c_opt.off_len + i2c_opt.count; cmd.buf = (void*)buf; cmd.last = 0; if (i2c_do_write(fd, &cmd)) return (i2c_do_stop(fd) | 1); break; } return (i2c_do_stop(fd)); } static int i2c_read(int fd, struct options i2c_opt, uint8_t *i2c_buf) { struct iiccmd cmd; char data = 0; memset(&cmd, 0, sizeof(cmd)); cmd.slave = i2c_opt.addr; if (i2c_opt.off_len) { cmd.count = 1; cmd.last = 0; cmd.buf = &data; if (i2c_do_start(fd, &cmd)) return (i2c_do_stop(fd) | 1); if (write_offset(fd, i2c_opt, &cmd)) return (i2c_do_stop(fd) | 1); if (i2c_opt.mode == I2C_MODE_STOP_START && i2c_do_stop(fd)) return (1); } cmd.slave = i2c_opt.addr | 1; cmd.count = 1; cmd.last = 0; cmd.buf = &data; if (i2c_opt.mode == I2C_MODE_STOP_START || i2c_opt.off_len == 0) { if (i2c_do_start(fd, &cmd)) return (i2c_do_stop(fd) | 1); } else if (i2c_opt.mode == I2C_MODE_REPEATED_START) { if (i2c_do_repeatstart(fd, &cmd)) return (i2c_do_stop(fd) | 1); } cmd.count = i2c_opt.count; cmd.buf = (void*)i2c_buf; cmd.last = 1; if (i2c_do_read(fd, &cmd)) return (i2c_do_stop(fd) | 1); return (i2c_do_stop(fd)); } /* * i2c_rdwr_transfer() - use I2CRDWR to conduct a complete i2c transfer. * * Some i2c hardware is unable to provide direct control over START, REPEAT- * START, and STOP operations. Such hardware can only perform a complete * START--STOP or START--REPEAT-START--STOP sequence as a * single operation. The driver framework refers to this sequence as a * "transfer" so we call it "transfer mode". We assemble either one or two * iic_msg structures to describe the IO operations, and hand them off to the * driver to be handled as a single transfer. */ static int i2c_rdwr_transfer(int fd, struct options i2c_opt, uint8_t *i2c_buf) { struct iic_msg msgs[2], *msgp = msgs; struct iic_rdwr_data xfer; int flag = 0; if (i2c_opt.off_len) { msgp->flags = IIC_M_WR | IIC_M_NOSTOP; msgp->slave = i2c_opt.addr; msgp->buf = i2c_opt.off_buf; msgp->len = i2c_opt.off_len; msgp++; flag = IIC_M_NOSTART; } /* * If the transfer direction is write and we did a write of the offset * above, then we need to elide the start; this transfer is just more * writing that follows the one started above. For a read, we always do * a start; if we did an offset write above it'll be a repeat-start * because of the NOSTOP flag used above. */ if (i2c_opt.dir == 'w') msgp->flags = IIC_M_WR | flag; else msgp->flags = IIC_M_RD; msgp->slave = i2c_opt.addr; msgp->len = i2c_opt.count; msgp->buf = i2c_buf; msgp++; xfer.msgs = msgs; xfer.nmsgs = msgp - msgs; if (ioctl(fd, I2CRDWR, &xfer) == -1 ) err(1, "ioctl(I2CRDWR) failed"); return (0); } static int access_bus(int fd, struct options i2c_opt) { uint8_t i2c_buf[i2c_opt.count]; int error; unsigned u, chunk_size = 16; /* * For a write, read the data to be written to the chip from stdin. */ if (i2c_opt.dir == 'w') { if (i2c_opt.verbose && !i2c_opt.binary) fprintf(stderr, "Enter %u bytes of data: ", i2c_opt.count); if (fread(i2c_buf, 1, i2c_opt.count, stdin) != i2c_opt.count) err(1, "not enough data, exiting\n"); } if (i2c_opt.mode == I2C_MODE_TRANSFER) error = i2c_rdwr_transfer(fd, i2c_opt, i2c_buf); else if (i2c_opt.dir == 'w') error = i2c_write(fd, i2c_opt, i2c_buf); else error = i2c_read(fd, i2c_opt, i2c_buf); if (error == 0) { if (i2c_opt.dir == 'r' && i2c_opt.binary) { (void)fwrite(i2c_buf, 1, i2c_opt.count, stdout); } else if (i2c_opt.verbose || i2c_opt.dir == 'r') { if (i2c_opt.verbose) fprintf(stderr, "\nData %s (hex):\n", i2c_opt.dir == 'r' ? "read" : "written"); for (u = 0; u < i2c_opt.count; u++) { printf("%02hhx ", i2c_buf[u]); if ((u % chunk_size) == chunk_size - 1) printf("\n"); } if ((u % chunk_size) != 0) printf("\n"); } } return (error); } int main(int argc, char** argv) { struct options i2c_opt; const char *dev, *err_msg; int fd, error = 0, ch; const char *optflags = "a:f:d:o:w:c:m:n:sbvrh"; char do_what = 0; dev = I2C_DEV; /* Default values */ i2c_opt.off = 0; i2c_opt.verbose = 0; i2c_opt.dir = 'r'; /* direction = read */ i2c_opt.width = "8"; i2c_opt.count = 1; i2c_opt.binary = 0; /* ASCII text output */ i2c_opt.skip = NULL; /* scan all addresses */ i2c_opt.mode = I2C_MODE_NOTSET; /* Find out what we are going to do */ while ((ch = getopt(argc, argv, "a:f:d:o:w:c:m:n:sbvrh")) != -1) { switch(ch) { case 'a': case 'r': case 's': if (do_what) usage("Only one of [-a|-h|-r|-s]"); do_what = ch; break; case 'h': usage("Help:"); break; default: break; } } /* Then handle the legal subset of arguments */ switch (do_what) { case 0: usage("Pick one of [-a|-h|-r|-s]"); break; case 'a': optflags = "a:f:d:w:o:c:m:bv"; break; case 'r': optflags = "rf:v"; break; case 's': optflags = "sf:n:v"; break; default: assert("Bad do_what"); } optreset = 1; optind = 1; while ((ch = getopt(argc, argv, optflags)) != -1) { switch(ch) { case 'a': i2c_opt.addr = strtoul(optarg, 0, 16); if (i2c_opt.addr == 0 && errno == EINVAL) usage("Bad -a argument (hex)"); if (i2c_opt.addr == 0 || i2c_opt.addr > 0x7f) usage("Bad -a argument (01..7f)"); i2c_opt.addr <<= 1; break; - case 'f': - dev = optarg; + case 'b': + i2c_opt.binary = 1; + break; + case 'c': + i2c_opt.count = (strtoul(optarg, 0, 10)); + if (i2c_opt.count == 0 && errno == EINVAL) + usage("Bad -c argument (decimal)"); break; case 'd': if (strcmp(optarg, "r") && strcmp(optarg, "w")) usage("Bad -d argument ([r|w])"); i2c_opt.dir = optarg[0]; break; - case 'o': - i2c_opt.off = strtoul(optarg, 0, 16); - if (i2c_opt.off == 0 && errno == EINVAL) - usage("Bad -o argument (hex)"); - break; - case 'w': - i2c_opt.width = optarg; // checked later. - break; - case 'c': - i2c_opt.count = (strtoul(optarg, 0, 10)); - if (i2c_opt.count == 0 && errno == EINVAL) - usage("Bad -c argument (decimal)"); + case 'f': + dev = optarg; break; case 'm': if (!strcmp(optarg, "no")) i2c_opt.mode = I2C_MODE_NONE; else if (!strcmp(optarg, "ss")) i2c_opt.mode = I2C_MODE_STOP_START; else if (!strcmp(optarg, "rs")) i2c_opt.mode = I2C_MODE_REPEATED_START; else if (!strcmp(optarg, "tr")) i2c_opt.mode = I2C_MODE_TRANSFER; else usage("Bad -m argument ([no|ss|rs|tr])"); break; case 'n': i2c_opt.skip = optarg; break; - case 's': break; - case 'b': - i2c_opt.binary = 1; + case 'o': + i2c_opt.off = strtoul(optarg, 0, 16); + if (i2c_opt.off == 0 && errno == EINVAL) + usage("Bad -o argument (hex)"); break; + case 'r': break; + case 's': break; case 'v': i2c_opt.verbose = 1; break; - case 'r': break; + case 'w': + i2c_opt.width = optarg; // checked later. + break; default: fprintf(stderr, "Illegal -%c option", ch); usage(NULL); } } argc -= optind; argv += optind; if (argc > 0) usage("Too many arguments"); /* Set default mode if option -m is not specified */ if (i2c_opt.mode == I2C_MODE_NOTSET) { if (i2c_opt.dir == 'r') i2c_opt.mode = I2C_MODE_STOP_START; else if (i2c_opt.dir == 'w') i2c_opt.mode = I2C_MODE_NONE; } err_msg = encode_offset(i2c_opt.width, i2c_opt.off, i2c_opt.off_buf, &i2c_opt.off_len); if (err_msg != NULL) { fprintf(stderr, "%s", err_msg); - exit(EX_USAGE); + return(EX_USAGE); } if (i2c_opt.verbose) fprintf(stderr, "dev: %s, addr: 0x%x, r/w: %c, " "offset: 0x%02x, width: %s, count: %u\n", dev, i2c_opt.addr >> 1, i2c_opt.dir, i2c_opt.off, i2c_opt.width, i2c_opt.count); fd = open(dev, O_RDWR); if (fd == -1) { fprintf(stderr, "Error opening I2C controller (%s): %s\n", dev, strerror(errno)); return (EX_NOINPUT); } switch (do_what) { + case 'a': + error = access_bus(fd, i2c_opt); + break; case 's': error = scan_bus(dev, fd, i2c_opt.skip, i2c_opt.verbose); break; case 'r': error = reset_bus(dev, fd, i2c_opt.verbose); break; - case 'a': - error = access_bus(fd, i2c_opt); - break; default: assert("Bad do_what"); } ch = close(fd); assert(ch == 0); return (error); }