blob: 788d42f2aad9e6bd591611ba207ad26749f2ef72 [file] [log] [blame]
Wolfram Sang22c78d12017-05-23 12:27:17 +02001/*
2 * Linux I2C core SMBus and SMBus emulation code
3 *
4 * This file contains the SMBus functions which are always included in the I2C
5 * core because they can be emulated via I2C. SMBus specific extensions
6 * (e.g. smbalert) are handled in a seperate i2c-smbus module.
7 *
8 * All SMBus-related things are written by Frodo Looijaard <frodol@dds.nl>
9 * SMBus 2.0 support by Mark Studebaker <mdsxyz123@yahoo.com> and
10 * Jean Delvare <jdelvare@suse.de>
11 *
12 * This program is free software; you can redistribute it and/or modify it
13 * under the terms of the GNU General Public License as published by the Free
14 * Software Foundation; either version 2 of the License, or (at your option)
15 * any later version.
16 */
17#include <linux/device.h>
18#include <linux/err.h>
19#include <linux/i2c.h>
Phil Reid3c0a60b2017-08-24 17:31:02 +080020#include <linux/i2c-smbus.h>
Wolfram Sang8a778212017-11-04 21:20:06 +010021#include <linux/slab.h>
Wolfram Sang22c78d12017-05-23 12:27:17 +020022
Wolfram Sang83c42212019-04-03 14:40:09 +020023#include "i2c-core.h"
24
Wolfram Sang22c78d12017-05-23 12:27:17 +020025#define CREATE_TRACE_POINTS
26#include <trace/events/smbus.h>
27
28
29/* The SMBus parts */
30
31#define POLY (0x1070U << 3)
32static u8 crc8(u16 data)
33{
34 int i;
35
36 for (i = 0; i < 8; i++) {
37 if (data & 0x8000)
38 data = data ^ POLY;
39 data = data << 1;
40 }
41 return (u8)(data >> 8);
42}
43
44/* Incremental CRC8 over count bytes in the array pointed to by p */
45static u8 i2c_smbus_pec(u8 crc, u8 *p, size_t count)
46{
47 int i;
48
49 for (i = 0; i < count; i++)
50 crc = crc8((crc ^ p[i]) << 8);
51 return crc;
52}
53
54/* Assume a 7-bit address, which is reasonable for SMBus */
55static u8 i2c_smbus_msg_pec(u8 pec, struct i2c_msg *msg)
56{
57 /* The address will be sent first */
58 u8 addr = i2c_8bit_addr_from_msg(msg);
59 pec = i2c_smbus_pec(pec, &addr, 1);
60
61 /* The data buffer follows */
62 return i2c_smbus_pec(pec, msg->buf, msg->len);
63}
64
65/* Used for write only transactions */
66static inline void i2c_smbus_add_pec(struct i2c_msg *msg)
67{
68 msg->buf[msg->len] = i2c_smbus_msg_pec(0, msg);
69 msg->len++;
70}
71
72/* Return <0 on CRC error
73 If there was a write before this read (most cases) we need to take the
74 partial CRC from the write part into account.
75 Note that this function does modify the message (we need to decrease the
76 message length to hide the CRC byte from the caller). */
77static int i2c_smbus_check_pec(u8 cpec, struct i2c_msg *msg)
78{
79 u8 rpec = msg->buf[--msg->len];
80 cpec = i2c_smbus_msg_pec(cpec, msg);
81
82 if (rpec != cpec) {
83 pr_debug("Bad PEC 0x%02x vs. 0x%02x\n",
84 rpec, cpec);
85 return -EBADMSG;
86 }
87 return 0;
88}
89
90/**
91 * i2c_smbus_read_byte - SMBus "receive byte" protocol
92 * @client: Handle to slave device
93 *
94 * This executes the SMBus "receive byte" protocol, returning negative errno
95 * else the byte received from the device.
96 */
97s32 i2c_smbus_read_byte(const struct i2c_client *client)
98{
99 union i2c_smbus_data data;
100 int status;
101
102 status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
103 I2C_SMBUS_READ, 0,
104 I2C_SMBUS_BYTE, &data);
105 return (status < 0) ? status : data.byte;
106}
107EXPORT_SYMBOL(i2c_smbus_read_byte);
108
109/**
110 * i2c_smbus_write_byte - SMBus "send byte" protocol
111 * @client: Handle to slave device
112 * @value: Byte to be sent
113 *
114 * This executes the SMBus "send byte" protocol, returning negative errno
115 * else zero on success.
116 */
117s32 i2c_smbus_write_byte(const struct i2c_client *client, u8 value)
118{
119 return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
120 I2C_SMBUS_WRITE, value, I2C_SMBUS_BYTE, NULL);
121}
122EXPORT_SYMBOL(i2c_smbus_write_byte);
123
124/**
125 * i2c_smbus_read_byte_data - SMBus "read byte" protocol
126 * @client: Handle to slave device
127 * @command: Byte interpreted by slave
128 *
129 * This executes the SMBus "read byte" protocol, returning negative errno
130 * else a data byte received from the device.
131 */
132s32 i2c_smbus_read_byte_data(const struct i2c_client *client, u8 command)
133{
134 union i2c_smbus_data data;
135 int status;
136
137 status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
138 I2C_SMBUS_READ, command,
139 I2C_SMBUS_BYTE_DATA, &data);
140 return (status < 0) ? status : data.byte;
141}
142EXPORT_SYMBOL(i2c_smbus_read_byte_data);
143
144/**
145 * i2c_smbus_write_byte_data - SMBus "write byte" protocol
146 * @client: Handle to slave device
147 * @command: Byte interpreted by slave
148 * @value: Byte being written
149 *
150 * This executes the SMBus "write byte" protocol, returning negative errno
151 * else zero on success.
152 */
153s32 i2c_smbus_write_byte_data(const struct i2c_client *client, u8 command,
154 u8 value)
155{
156 union i2c_smbus_data data;
157 data.byte = value;
158 return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
159 I2C_SMBUS_WRITE, command,
160 I2C_SMBUS_BYTE_DATA, &data);
161}
162EXPORT_SYMBOL(i2c_smbus_write_byte_data);
163
164/**
165 * i2c_smbus_read_word_data - SMBus "read word" protocol
166 * @client: Handle to slave device
167 * @command: Byte interpreted by slave
168 *
169 * This executes the SMBus "read word" protocol, returning negative errno
170 * else a 16-bit unsigned "word" received from the device.
171 */
172s32 i2c_smbus_read_word_data(const struct i2c_client *client, u8 command)
173{
174 union i2c_smbus_data data;
175 int status;
176
177 status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
178 I2C_SMBUS_READ, command,
179 I2C_SMBUS_WORD_DATA, &data);
180 return (status < 0) ? status : data.word;
181}
182EXPORT_SYMBOL(i2c_smbus_read_word_data);
183
184/**
185 * i2c_smbus_write_word_data - SMBus "write word" protocol
186 * @client: Handle to slave device
187 * @command: Byte interpreted by slave
188 * @value: 16-bit "word" being written
189 *
190 * This executes the SMBus "write word" protocol, returning negative errno
191 * else zero on success.
192 */
193s32 i2c_smbus_write_word_data(const struct i2c_client *client, u8 command,
194 u16 value)
195{
196 union i2c_smbus_data data;
197 data.word = value;
198 return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
199 I2C_SMBUS_WRITE, command,
200 I2C_SMBUS_WORD_DATA, &data);
201}
202EXPORT_SYMBOL(i2c_smbus_write_word_data);
203
204/**
205 * i2c_smbus_read_block_data - SMBus "block read" protocol
206 * @client: Handle to slave device
207 * @command: Byte interpreted by slave
208 * @values: Byte array into which data will be read; big enough to hold
209 * the data returned by the slave. SMBus allows at most 32 bytes.
210 *
211 * This executes the SMBus "block read" protocol, returning negative errno
212 * else the number of data bytes in the slave's response.
213 *
214 * Note that using this function requires that the client's adapter support
215 * the I2C_FUNC_SMBUS_READ_BLOCK_DATA functionality. Not all adapter drivers
216 * support this; its emulation through I2C messaging relies on a specific
217 * mechanism (I2C_M_RECV_LEN) which may not be implemented.
218 */
219s32 i2c_smbus_read_block_data(const struct i2c_client *client, u8 command,
220 u8 *values)
221{
222 union i2c_smbus_data data;
223 int status;
224
225 status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
226 I2C_SMBUS_READ, command,
227 I2C_SMBUS_BLOCK_DATA, &data);
228 if (status)
229 return status;
230
231 memcpy(values, &data.block[1], data.block[0]);
232 return data.block[0];
233}
234EXPORT_SYMBOL(i2c_smbus_read_block_data);
235
236/**
237 * i2c_smbus_write_block_data - SMBus "block write" protocol
238 * @client: Handle to slave device
239 * @command: Byte interpreted by slave
240 * @length: Size of data block; SMBus allows at most 32 bytes
241 * @values: Byte array which will be written.
242 *
243 * This executes the SMBus "block write" protocol, returning negative errno
244 * else zero on success.
245 */
246s32 i2c_smbus_write_block_data(const struct i2c_client *client, u8 command,
247 u8 length, const u8 *values)
248{
249 union i2c_smbus_data data;
250
251 if (length > I2C_SMBUS_BLOCK_MAX)
252 length = I2C_SMBUS_BLOCK_MAX;
253 data.block[0] = length;
254 memcpy(&data.block[1], values, length);
255 return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
256 I2C_SMBUS_WRITE, command,
257 I2C_SMBUS_BLOCK_DATA, &data);
258}
259EXPORT_SYMBOL(i2c_smbus_write_block_data);
260
261/* Returns the number of read bytes */
262s32 i2c_smbus_read_i2c_block_data(const struct i2c_client *client, u8 command,
263 u8 length, u8 *values)
264{
265 union i2c_smbus_data data;
266 int status;
267
268 if (length > I2C_SMBUS_BLOCK_MAX)
269 length = I2C_SMBUS_BLOCK_MAX;
270 data.block[0] = length;
271 status = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
272 I2C_SMBUS_READ, command,
273 I2C_SMBUS_I2C_BLOCK_DATA, &data);
274 if (status < 0)
275 return status;
276
277 memcpy(values, &data.block[1], data.block[0]);
278 return data.block[0];
279}
280EXPORT_SYMBOL(i2c_smbus_read_i2c_block_data);
281
282s32 i2c_smbus_write_i2c_block_data(const struct i2c_client *client, u8 command,
283 u8 length, const u8 *values)
284{
285 union i2c_smbus_data data;
286
287 if (length > I2C_SMBUS_BLOCK_MAX)
288 length = I2C_SMBUS_BLOCK_MAX;
289 data.block[0] = length;
290 memcpy(data.block + 1, values, length);
291 return i2c_smbus_xfer(client->adapter, client->addr, client->flags,
292 I2C_SMBUS_WRITE, command,
293 I2C_SMBUS_I2C_BLOCK_DATA, &data);
294}
295EXPORT_SYMBOL(i2c_smbus_write_i2c_block_data);
296
Wolfram Sang8a778212017-11-04 21:20:06 +0100297static void i2c_smbus_try_get_dmabuf(struct i2c_msg *msg, u8 init_val)
298{
299 bool is_read = msg->flags & I2C_M_RD;
300 unsigned char *dma_buf;
301
302 dma_buf = kzalloc(I2C_SMBUS_BLOCK_MAX + (is_read ? 2 : 3), GFP_KERNEL);
303 if (!dma_buf)
304 return;
305
306 msg->buf = dma_buf;
307 msg->flags |= I2C_M_DMA_SAFE;
308
309 if (init_val)
310 msg->buf[0] = init_val;
311}
312
Wolfram Sangbe5b9282018-02-26 22:17:53 +0100313/*
314 * Simulate a SMBus command using the I2C protocol.
315 * No checking of parameters is done!
316 */
Wolfram Sang22c78d12017-05-23 12:27:17 +0200317static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr,
318 unsigned short flags,
319 char read_write, u8 command, int size,
320 union i2c_smbus_data *data)
321{
Wolfram Sangbe5b9282018-02-26 22:17:53 +0100322 /*
323 * So we need to generate a series of msgs. In the case of writing, we
324 * need to use only one message; when reading, we need two. We
325 * initialize most things with sane defaults, to keep the code below
326 * somewhat simpler.
327 */
Wolfram Sang22c78d12017-05-23 12:27:17 +0200328 unsigned char msgbuf0[I2C_SMBUS_BLOCK_MAX+3];
329 unsigned char msgbuf1[I2C_SMBUS_BLOCK_MAX+2];
330 int num = read_write == I2C_SMBUS_READ ? 2 : 1;
331 int i;
332 u8 partial_pec = 0;
333 int status;
334 struct i2c_msg msg[2] = {
335 {
336 .addr = addr,
337 .flags = flags,
338 .len = 1,
339 .buf = msgbuf0,
340 }, {
341 .addr = addr,
342 .flags = flags | I2C_M_RD,
343 .len = 0,
344 .buf = msgbuf1,
345 },
346 };
347
348 msgbuf0[0] = command;
349 switch (size) {
350 case I2C_SMBUS_QUICK:
351 msg[0].len = 0;
352 /* Special case: The read/write field is used as data */
353 msg[0].flags = flags | (read_write == I2C_SMBUS_READ ?
354 I2C_M_RD : 0);
355 num = 1;
356 break;
357 case I2C_SMBUS_BYTE:
358 if (read_write == I2C_SMBUS_READ) {
359 /* Special case: only a read! */
360 msg[0].flags = I2C_M_RD | flags;
361 num = 1;
362 }
363 break;
364 case I2C_SMBUS_BYTE_DATA:
365 if (read_write == I2C_SMBUS_READ)
366 msg[1].len = 1;
367 else {
368 msg[0].len = 2;
369 msgbuf0[1] = data->byte;
370 }
371 break;
372 case I2C_SMBUS_WORD_DATA:
373 if (read_write == I2C_SMBUS_READ)
374 msg[1].len = 2;
375 else {
376 msg[0].len = 3;
377 msgbuf0[1] = data->word & 0xff;
378 msgbuf0[2] = data->word >> 8;
379 }
380 break;
381 case I2C_SMBUS_PROC_CALL:
382 num = 2; /* Special case */
383 read_write = I2C_SMBUS_READ;
384 msg[0].len = 3;
385 msg[1].len = 2;
386 msgbuf0[1] = data->word & 0xff;
387 msgbuf0[2] = data->word >> 8;
388 break;
389 case I2C_SMBUS_BLOCK_DATA:
390 if (read_write == I2C_SMBUS_READ) {
391 msg[1].flags |= I2C_M_RECV_LEN;
392 msg[1].len = 1; /* block length will be added by
393 the underlying bus driver */
Wolfram Sang8a778212017-11-04 21:20:06 +0100394 i2c_smbus_try_get_dmabuf(&msg[1], 0);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200395 } else {
396 msg[0].len = data->block[0] + 2;
397 if (msg[0].len > I2C_SMBUS_BLOCK_MAX + 2) {
398 dev_err(&adapter->dev,
399 "Invalid block write size %d\n",
400 data->block[0]);
401 return -EINVAL;
402 }
Wolfram Sang8a778212017-11-04 21:20:06 +0100403
404 i2c_smbus_try_get_dmabuf(&msg[0], command);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200405 for (i = 1; i < msg[0].len; i++)
Wolfram Sang8a778212017-11-04 21:20:06 +0100406 msg[0].buf[i] = data->block[i - 1];
Wolfram Sang22c78d12017-05-23 12:27:17 +0200407 }
408 break;
409 case I2C_SMBUS_BLOCK_PROC_CALL:
410 num = 2; /* Another special case */
411 read_write = I2C_SMBUS_READ;
412 if (data->block[0] > I2C_SMBUS_BLOCK_MAX) {
413 dev_err(&adapter->dev,
414 "Invalid block write size %d\n",
415 data->block[0]);
416 return -EINVAL;
417 }
Wolfram Sang8a778212017-11-04 21:20:06 +0100418
Wolfram Sang22c78d12017-05-23 12:27:17 +0200419 msg[0].len = data->block[0] + 2;
Wolfram Sang8a778212017-11-04 21:20:06 +0100420 i2c_smbus_try_get_dmabuf(&msg[0], command);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200421 for (i = 1; i < msg[0].len; i++)
Wolfram Sang8a778212017-11-04 21:20:06 +0100422 msg[0].buf[i] = data->block[i - 1];
423
Wolfram Sang22c78d12017-05-23 12:27:17 +0200424 msg[1].flags |= I2C_M_RECV_LEN;
425 msg[1].len = 1; /* block length will be added by
426 the underlying bus driver */
Wolfram Sang8a778212017-11-04 21:20:06 +0100427 i2c_smbus_try_get_dmabuf(&msg[1], 0);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200428 break;
429 case I2C_SMBUS_I2C_BLOCK_DATA:
Jeremy Compostella89c6efa2017-11-15 12:31:44 -0700430 if (data->block[0] > I2C_SMBUS_BLOCK_MAX) {
431 dev_err(&adapter->dev, "Invalid block %s size %d\n",
432 read_write == I2C_SMBUS_READ ? "read" : "write",
433 data->block[0]);
434 return -EINVAL;
435 }
436
Wolfram Sang22c78d12017-05-23 12:27:17 +0200437 if (read_write == I2C_SMBUS_READ) {
438 msg[1].len = data->block[0];
Wolfram Sang8a778212017-11-04 21:20:06 +0100439 i2c_smbus_try_get_dmabuf(&msg[1], 0);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200440 } else {
441 msg[0].len = data->block[0] + 1;
Wolfram Sang8a778212017-11-04 21:20:06 +0100442
443 i2c_smbus_try_get_dmabuf(&msg[0], command);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200444 for (i = 1; i <= data->block[0]; i++)
Wolfram Sang8a778212017-11-04 21:20:06 +0100445 msg[0].buf[i] = data->block[i];
Wolfram Sang22c78d12017-05-23 12:27:17 +0200446 }
447 break;
448 default:
449 dev_err(&adapter->dev, "Unsupported transaction %d\n", size);
450 return -EOPNOTSUPP;
451 }
452
453 i = ((flags & I2C_CLIENT_PEC) && size != I2C_SMBUS_QUICK
454 && size != I2C_SMBUS_I2C_BLOCK_DATA);
455 if (i) {
456 /* Compute PEC if first message is a write */
457 if (!(msg[0].flags & I2C_M_RD)) {
458 if (num == 1) /* Write only */
459 i2c_smbus_add_pec(&msg[0]);
460 else /* Write followed by read */
461 partial_pec = i2c_smbus_msg_pec(0, &msg[0]);
462 }
463 /* Ask for PEC if last message is a read */
464 if (msg[num-1].flags & I2C_M_RD)
465 msg[num-1].len++;
466 }
467
Peter Rosineef5ba12018-06-20 10:51:53 +0200468 status = __i2c_transfer(adapter, msg, num);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200469 if (status < 0)
Peter Rosin9aa61362018-06-20 11:43:23 +0200470 goto cleanup;
471 if (status != num) {
472 status = -EIO;
473 goto cleanup;
474 }
475 status = 0;
Wolfram Sang22c78d12017-05-23 12:27:17 +0200476
477 /* Check PEC if last message is a read */
478 if (i && (msg[num-1].flags & I2C_M_RD)) {
479 status = i2c_smbus_check_pec(partial_pec, &msg[num-1]);
480 if (status < 0)
Peter Rosin9aa61362018-06-20 11:43:23 +0200481 goto cleanup;
Wolfram Sang22c78d12017-05-23 12:27:17 +0200482 }
483
484 if (read_write == I2C_SMBUS_READ)
485 switch (size) {
486 case I2C_SMBUS_BYTE:
487 data->byte = msgbuf0[0];
488 break;
489 case I2C_SMBUS_BYTE_DATA:
490 data->byte = msgbuf1[0];
491 break;
492 case I2C_SMBUS_WORD_DATA:
493 case I2C_SMBUS_PROC_CALL:
494 data->word = msgbuf1[0] | (msgbuf1[1] << 8);
495 break;
496 case I2C_SMBUS_I2C_BLOCK_DATA:
497 for (i = 0; i < data->block[0]; i++)
Wolfram Sang8a778212017-11-04 21:20:06 +0100498 data->block[i + 1] = msg[1].buf[i];
Wolfram Sang22c78d12017-05-23 12:27:17 +0200499 break;
500 case I2C_SMBUS_BLOCK_DATA:
501 case I2C_SMBUS_BLOCK_PROC_CALL:
Wolfram Sang8a778212017-11-04 21:20:06 +0100502 for (i = 0; i < msg[1].buf[0] + 1; i++)
503 data->block[i] = msg[1].buf[i];
Wolfram Sang22c78d12017-05-23 12:27:17 +0200504 break;
505 }
Wolfram Sang8a778212017-11-04 21:20:06 +0100506
Peter Rosin9aa61362018-06-20 11:43:23 +0200507cleanup:
Wolfram Sang8a778212017-11-04 21:20:06 +0100508 if (msg[0].flags & I2C_M_DMA_SAFE)
509 kfree(msg[0].buf);
510 if (msg[1].flags & I2C_M_DMA_SAFE)
511 kfree(msg[1].buf);
512
Peter Rosin9aa61362018-06-20 11:43:23 +0200513 return status;
Wolfram Sang22c78d12017-05-23 12:27:17 +0200514}
515
516/**
517 * i2c_smbus_xfer - execute SMBus protocol operations
518 * @adapter: Handle to I2C bus
519 * @addr: Address of SMBus slave on that bus
520 * @flags: I2C_CLIENT_* flags (usually zero or I2C_CLIENT_PEC)
521 * @read_write: I2C_SMBUS_READ or I2C_SMBUS_WRITE
522 * @command: Byte interpreted by slave, for protocols which use such bytes
523 * @protocol: SMBus protocol operation to execute, such as I2C_SMBUS_PROC_CALL
524 * @data: Data to be read or written
525 *
526 * This executes an SMBus protocol operation, and returns a negative
527 * errno code else zero on success.
528 */
Peter Rosineef5ba12018-06-20 10:51:53 +0200529s32 i2c_smbus_xfer(struct i2c_adapter *adapter, u16 addr,
530 unsigned short flags, char read_write,
531 u8 command, int protocol, union i2c_smbus_data *data)
532{
533 s32 res;
534
Wolfram Sang83c42212019-04-03 14:40:09 +0200535 res = __i2c_lock_bus_helper(adapter);
536 if (res)
537 return res;
538
Peter Rosineef5ba12018-06-20 10:51:53 +0200539 res = __i2c_smbus_xfer(adapter, addr, flags, read_write,
540 command, protocol, data);
541 i2c_unlock_bus(adapter, I2C_LOCK_SEGMENT);
542
543 return res;
544}
545EXPORT_SYMBOL(i2c_smbus_xfer);
546
547s32 __i2c_smbus_xfer(struct i2c_adapter *adapter, u16 addr,
548 unsigned short flags, char read_write,
549 u8 command, int protocol, union i2c_smbus_data *data)
Wolfram Sang22c78d12017-05-23 12:27:17 +0200550{
Wolfram Sang63b96982019-04-03 14:40:10 +0200551 int (*xfer_func)(struct i2c_adapter *adap, u16 addr,
552 unsigned short flags, char read_write,
553 u8 command, int size, union i2c_smbus_data *data);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200554 unsigned long orig_jiffies;
555 int try;
556 s32 res;
557
Wolfram Sang5d756112019-04-25 16:19:48 +0200558 res = __i2c_check_suspended(adapter);
559 if (res)
560 return res;
561
Wolfram Sang22c78d12017-05-23 12:27:17 +0200562 /* If enabled, the following two tracepoints are conditional on
563 * read_write and protocol.
564 */
565 trace_smbus_write(adapter, addr, flags, read_write,
566 command, protocol, data);
567 trace_smbus_read(adapter, addr, flags, read_write,
568 command, protocol);
569
570 flags &= I2C_M_TEN | I2C_CLIENT_PEC | I2C_CLIENT_SCCB;
571
Wolfram Sang63b96982019-04-03 14:40:10 +0200572 xfer_func = adapter->algo->smbus_xfer;
573 if (i2c_in_atomic_xfer_mode()) {
574 if (adapter->algo->smbus_xfer_atomic)
575 xfer_func = adapter->algo->smbus_xfer_atomic;
576 else if (adapter->algo->master_xfer_atomic)
577 xfer_func = NULL; /* fallback to I2C emulation */
578 }
579
580 if (xfer_func) {
Wolfram Sang22c78d12017-05-23 12:27:17 +0200581 /* Retry automatically on arbitration loss */
582 orig_jiffies = jiffies;
583 for (res = 0, try = 0; try <= adapter->retries; try++) {
Wolfram Sang63b96982019-04-03 14:40:10 +0200584 res = xfer_func(adapter, addr, flags, read_write,
585 command, protocol, data);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200586 if (res != -EAGAIN)
587 break;
588 if (time_after(jiffies,
589 orig_jiffies + adapter->timeout))
590 break;
591 }
Wolfram Sang22c78d12017-05-23 12:27:17 +0200592
593 if (res != -EOPNOTSUPP || !adapter->algo->master_xfer)
594 goto trace;
595 /*
596 * Fall back to i2c_smbus_xfer_emulated if the adapter doesn't
597 * implement native support for the SMBus operation.
598 */
599 }
600
601 res = i2c_smbus_xfer_emulated(adapter, addr, flags, read_write,
602 command, protocol, data);
603
604trace:
605 /* If enabled, the reply tracepoint is conditional on read_write. */
606 trace_smbus_reply(adapter, addr, flags, read_write,
John Sperbeckd8434c32019-02-12 19:40:57 -0800607 command, protocol, data, res);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200608 trace_smbus_result(adapter, addr, flags, read_write,
609 command, protocol, res);
610
611 return res;
612}
Peter Rosineef5ba12018-06-20 10:51:53 +0200613EXPORT_SYMBOL(__i2c_smbus_xfer);
Wolfram Sang22c78d12017-05-23 12:27:17 +0200614
615/**
616 * i2c_smbus_read_i2c_block_data_or_emulated - read block or emulate
617 * @client: Handle to slave device
618 * @command: Byte interpreted by slave
619 * @length: Size of data block; SMBus allows at most I2C_SMBUS_BLOCK_MAX bytes
620 * @values: Byte array into which data will be read; big enough to hold
621 * the data returned by the slave. SMBus allows at most
622 * I2C_SMBUS_BLOCK_MAX bytes.
623 *
624 * This executes the SMBus "block read" protocol if supported by the adapter.
625 * If block read is not supported, it emulates it using either word or byte
626 * read protocols depending on availability.
627 *
628 * The addresses of the I2C slave device that are accessed with this function
629 * must be mapped to a linear region, so that a block read will have the same
630 * effect as a byte read. Before using this function you must double-check
631 * if the I2C slave does support exchanging a block transfer with a byte
632 * transfer.
633 */
634s32 i2c_smbus_read_i2c_block_data_or_emulated(const struct i2c_client *client,
635 u8 command, u8 length, u8 *values)
636{
637 u8 i = 0;
638 int status;
639
640 if (length > I2C_SMBUS_BLOCK_MAX)
641 length = I2C_SMBUS_BLOCK_MAX;
642
643 if (i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_READ_I2C_BLOCK))
644 return i2c_smbus_read_i2c_block_data(client, command, length, values);
645
646 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_READ_BYTE_DATA))
647 return -EOPNOTSUPP;
648
649 if (i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_READ_WORD_DATA)) {
650 while ((i + 2) <= length) {
651 status = i2c_smbus_read_word_data(client, command + i);
652 if (status < 0)
653 return status;
654 values[i] = status & 0xff;
655 values[i + 1] = status >> 8;
656 i += 2;
657 }
658 }
659
660 while (i < length) {
661 status = i2c_smbus_read_byte_data(client, command + i);
662 if (status < 0)
663 return status;
664 values[i] = status;
665 i++;
666 }
667
668 return i;
669}
670EXPORT_SYMBOL(i2c_smbus_read_i2c_block_data_or_emulated);
Phil Reid3c0a60b2017-08-24 17:31:02 +0800671
672/**
673 * i2c_setup_smbus_alert - Setup SMBus alert support
674 * @adapter: the target adapter
675 * @setup: setup data for the SMBus alert handler
676 * Context: can sleep
677 *
678 * Setup handling of the SMBus alert protocol on a given I2C bus segment.
679 *
680 * Handling can be done either through our IRQ handler, or by the
681 * adapter (from its handler, periodic polling, or whatever).
682 *
683 * NOTE that if we manage the IRQ, we *MUST* know if it's level or
684 * edge triggered in order to hand it to the workqueue correctly.
685 * If triggering the alert seems to wedge the system, you probably
686 * should have said it's level triggered.
687 *
688 * This returns the ara client, which should be saved for later use with
689 * i2c_handle_smbus_alert() and ultimately i2c_unregister_device(); or NULL
690 * to indicate an error.
691 */
692struct i2c_client *i2c_setup_smbus_alert(struct i2c_adapter *adapter,
693 struct i2c_smbus_alert_setup *setup)
694{
695 struct i2c_board_info ara_board_info = {
696 I2C_BOARD_INFO("smbus_alert", 0x0c),
697 .platform_data = setup,
698 };
699
700 return i2c_new_device(adapter, &ara_board_info);
701}
702EXPORT_SYMBOL_GPL(i2c_setup_smbus_alert);
Phil Reid69d17242017-08-24 17:31:03 +0800703
704#if IS_ENABLED(CONFIG_I2C_SMBUS) && IS_ENABLED(CONFIG_OF)
705int of_i2c_setup_smbus_alert(struct i2c_adapter *adapter)
706{
707 struct i2c_client *client;
708 int irq;
709
710 irq = of_property_match_string(adapter->dev.of_node, "interrupt-names",
711 "smbus_alert");
712 if (irq == -EINVAL || irq == -ENODATA)
713 return 0;
714 else if (irq < 0)
715 return irq;
716
717 client = i2c_setup_smbus_alert(adapter, NULL);
718 if (!client)
719 return -ENODEV;
720
721 return 0;
722}
723EXPORT_SYMBOL_GPL(of_i2c_setup_smbus_alert);
724#endif