root/i2c-tools/trunk/tools/i2cset.c @ 5242

Revision 5242, 7.6 KB (checked in by khali, 6 years ago)

Use consistent transaction names (based on the SMBus specification)
when complaining about a missing adapter functionality.

  • Property svn:eol-style set to native
  • Property svn:keywords set to Author Date Id Revision
Line 
1/*
2    i2cset.c - A user-space program to write an I2C register.
3    Copyright (C) 2001-2003  Frodo Looijaard <frodol@dds.nl>, and
4                             Mark D. Studebaker <mdsxyz123@yahoo.com>
5    Copyright (C) 2004-2008  Jean Delvare <khali@linux-fr.org>
6
7    This program is free software; you can redistribute it and/or modify
8    it under the terms of the GNU General Public License as published by
9    the Free Software Foundation; either version 2 of the License, or
10    (at your option) any later version.
11
12    This program is distributed in the hope that it will be useful,
13    but WITHOUT ANY WARRANTY; without even the implied warranty of
14    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15    GNU General Public License for more details.
16
17    You should have received a copy of the GNU General Public License
18    along with this program; if not, write to the Free Software
19    Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
20    MA 02110-1301 USA.
21*/
22
23#include <errno.h>
24#include <string.h>
25#include <stdio.h>
26#include <stdlib.h>
27#include <unistd.h>
28#include <linux/i2c-dev.h>
29#include "i2cbusses.h"
30#include "util.h"
31#include "../version.h"
32
33static void help(void) __attribute__ ((noreturn));
34
35static void help(void)
36{
37        fprintf(stderr,
38                "Usage: i2cset [-f] [-y] I2CBUS CHIP-ADDRESS DATA-ADDRESS [VALUE [MODE [MASK]]]\n"
39                "  I2CBUS is an integer or an I2C bus name\n"
40                "  ADDRESS is an integer (0x03 - 0x77)\n"
41                "  MODE is one of:\n"
42                "    b (byte, default)\n"
43                "    w (word)\n"
44                "    Append p for SMBus PEC\n");
45        exit(1);
46}
47
48static int check_funcs(int file, int size, int pec)
49{
50        unsigned long funcs;
51
52        /* check adapter functionality */
53        if (ioctl(file, I2C_FUNCS, &funcs) < 0) {
54                fprintf(stderr, "Error: Could not get the adapter "
55                        "functionality matrix: %s\n", strerror(errno));
56                return -1;
57        }
58
59        switch (size) {
60        case I2C_SMBUS_BYTE:
61                if (!(funcs & I2C_FUNC_SMBUS_WRITE_BYTE)) {
62                        fprintf(stderr, MISSING_FUNC_FMT, "SMBus send byte");
63                        return -1;
64                }
65                break;
66
67        case I2C_SMBUS_BYTE_DATA:
68                if (!(funcs & I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) {
69                        fprintf(stderr, MISSING_FUNC_FMT, "SMBus write byte");
70                        return -1;
71                }
72                break;
73
74        case I2C_SMBUS_WORD_DATA:
75                if (!(funcs & I2C_FUNC_SMBUS_WRITE_WORD_DATA)) {
76                        fprintf(stderr, MISSING_FUNC_FMT, "SMBus write word");
77                        return -1;
78                }
79                break;
80        }
81
82        if (pec
83         && !(funcs & (I2C_FUNC_SMBUS_PEC | I2C_FUNC_I2C))) {
84                fprintf(stderr, "Warning: Adapter does "
85                        "not seem to support PEC\n");
86        }
87
88        return 0;
89}
90
91static int confirm(const char *filename, int address, int size, int daddress,
92                   int value, int vmask, int pec)
93{
94        int dont = 0;
95
96        fprintf(stderr, "WARNING! This program can confuse your I2C "
97                "bus, cause data loss and worse!\n");
98
99        if (address >= 0x50 && address <= 0x57) {
100                fprintf(stderr, "DANGEROUS! Writing to a serial "
101                        "EEPROM on a memory DIMM\nmay render your "
102                        "memory USELESS and make your system "
103                        "UNBOOTABLE!\n");
104                dont++;
105        }
106
107        fprintf(stderr, "I will write to device file %s, chip address "
108                "0x%02x, data address\n0x%02x, ", filename, address, daddress);
109        if (size == I2C_SMBUS_BYTE)
110                fprintf(stderr, "no data.\n");
111        else
112                fprintf(stderr, "data 0x%02x%s, mode %s.\n", value,
113                        vmask ? " (masked)" : "",
114                        size == I2C_SMBUS_BYTE_DATA ? "byte" : "word");
115        if (pec)
116                fprintf(stderr, "PEC checking enabled.\n");
117
118        fprintf(stderr, "Continue? [%s] ", dont ? "y/N" : "Y/n");
119        fflush(stderr);
120        if (!user_ack(!dont)) {
121                fprintf(stderr, "Aborting on user request.\n");
122                return 0;
123        }
124
125        return 1;
126}
127
128int main(int argc, char *argv[])
129{
130        char *end;
131        int res, i2cbus, address, size, file;
132        int value, daddress, vmask = 0;
133        char filename[20];
134        int pec = 0;
135        int flags = 0;
136        int force = 0, yes = 0, version = 0;
137
138        /* handle (optional) flags first */
139        while (1+flags < argc && argv[1+flags][0] == '-') {
140                switch (argv[1+flags][1]) {
141                case 'V': version = 1; break;
142                case 'f': force = 1; break;
143                case 'y': yes = 1; break;
144                default:
145                        fprintf(stderr, "Error: Unsupported option "
146                                "\"%s\"!\n", argv[1+flags]);
147                        help();
148                        exit(1);
149                }
150                flags++;
151        }
152
153        if (version) {
154                fprintf(stderr, "i2cset version %s\n", VERSION);
155                exit(0);
156        }
157
158        if (argc < flags + 4)
159                help();
160
161        i2cbus = lookup_i2c_bus(argv[flags+1]);
162        if (i2cbus < 0)
163                help();
164
165        address = parse_i2c_address(argv[flags+2]);
166        if (address < 0)
167                help();
168
169        daddress = strtol(argv[flags+3], &end, 0);
170        if (*end || daddress < 0 || daddress > 0xff) {
171                fprintf(stderr, "Error: Data address invalid!\n");
172                help();
173        }
174
175        if (argc > flags + 4) {
176                size = I2C_SMBUS_BYTE_DATA;
177                value = strtol(argv[flags+4], &end, 0);
178                if (*end || value < 0) {
179                        fprintf(stderr, "Error: Data value invalid!\n");
180                        help();
181                }
182        } else {
183                size = I2C_SMBUS_BYTE;
184                value = -1;
185        }
186
187        if (argc > flags + 5) {
188                switch (argv[flags+5][0]) {
189                case 'b': size = I2C_SMBUS_BYTE_DATA; break;
190                case 'w': size = I2C_SMBUS_WORD_DATA; break;
191                default:
192                        fprintf(stderr, "Error: Invalid mode!\n");
193                        help();
194                }
195                pec = argv[flags+5][1] == 'p';
196        }
197
198        if (argc > flags + 6) {
199                vmask = strtol(argv[flags+6], &end, 0);
200                if (*end || vmask == 0) {
201                        fprintf(stderr, "Error: Data value mask invalid!\n");
202                        help();
203                }
204        }
205
206        if ((size == I2C_SMBUS_BYTE_DATA && value > 0xff)
207         || (size == I2C_SMBUS_WORD_DATA && value > 0xffff)) {
208                fprintf(stderr, "Error: Data value out of range!\n");
209                help();
210        }
211
212        file = open_i2c_dev(i2cbus, filename, 0);
213        if (file < 0
214         || check_funcs(file, size, pec)
215         || set_slave_addr(file, address, force))
216                exit(1);
217
218        if (!yes && !confirm(filename, address, size, daddress,
219                             value, vmask, pec))
220                exit(0);
221
222        if (vmask) {
223                int oldvalue;
224
225                if (size == I2C_SMBUS_WORD_DATA) {
226                        oldvalue = i2c_smbus_read_word_data(file, daddress);
227                } else {
228                        oldvalue = i2c_smbus_read_byte_data(file, daddress);
229                }
230
231                if (oldvalue < 0) {
232                        fprintf(stderr, "Error: Failed to read old value\n");
233                        exit(1);
234                }
235
236                value = (value & vmask) | (oldvalue & ~vmask);
237
238                if (!yes) {
239                        fprintf(stderr, "Old value 0x%0*x, write mask "
240                                "0x%0*x: Will write 0x%0*x to register "
241                                "0x%02x\n",
242                                size == I2C_SMBUS_WORD_DATA ? 4 : 2, oldvalue,
243                                size == I2C_SMBUS_WORD_DATA ? 4 : 2, vmask,
244                                size == I2C_SMBUS_WORD_DATA ? 4 : 2, value,
245                                daddress);
246
247                        fprintf(stderr, "Continue? [Y/n] ");
248                        fflush(stderr);
249                        if (!user_ack(1)) {
250                                fprintf(stderr, "Aborting on user request.\n");
251                                exit(0);
252                        }
253                }
254        }
255
256        if (pec && ioctl(file, I2C_PEC, 1) < 0) {
257                fprintf(stderr, "Error: Could not set PEC: %s\n",
258                        strerror(errno));
259                close(file);
260                exit(1);
261        }
262
263        switch (size) {
264        case I2C_SMBUS_BYTE:
265                res = i2c_smbus_write_byte(file, daddress);
266                break;
267        case I2C_SMBUS_WORD_DATA:
268                res = i2c_smbus_write_word_data(file, daddress, value);
269                break;
270        default: /* I2C_SMBUS_BYTE_DATA */
271                res = i2c_smbus_write_byte_data(file, daddress, value);
272        }
273        if (res < 0) {
274                fprintf(stderr, "Error: Write failed\n");
275                close(file);
276                exit(1);
277        }
278
279        if (pec) {
280                if (ioctl(file, I2C_PEC, 0) < 0) {
281                        fprintf(stderr, "Error: Could not clear PEC: %s\n",
282                                strerror(errno));
283                        close(file);
284                        exit(1);
285                }
286        }
287
288        switch (size) {
289        case I2C_SMBUS_BYTE:
290                /* No readback */
291                break;
292        case I2C_SMBUS_WORD_DATA:
293                res = i2c_smbus_read_word_data(file, daddress);
294                break;
295        default: /* I2C_SMBUS_BYTE_DATA */
296                res = i2c_smbus_read_byte_data(file, daddress);
297        }
298        close(file);
299
300        if (size == I2C_SMBUS_BYTE) /* We're done */
301                exit(0);
302
303        if (res < 0) {
304                printf("Warning - readback failed\n");
305        } else
306        if (res != value) {
307                printf("Warning - data mismatch - wrote "
308                       "0x%0*x, read back 0x%0*x\n",
309                       size == I2C_SMBUS_WORD_DATA ? 4 : 2, value,
310                       size == I2C_SMBUS_WORD_DATA ? 4 : 2, res);
311        } else {
312                printf("Value 0x%0*x written, readback matched\n",
313                       size == I2C_SMBUS_WORD_DATA ? 4 : 2, value);
314        }
315
316        exit(0);
317}
Note: See TracBrowser for help on using the browser.