|
1 | | -/* |
2 | | - ************************************************************************************ |
3 | | - * Copyright (c) [2025] ams-OSRAM AG * |
4 | | - * * |
5 | | - * SPDX-License-Identifier: GPL-2.0 OR MIT * |
6 | | - * * |
7 | | - * For the full license texts, see LICENSES-GPL-2.0.txt or LICENSES-MIT.TXT. * |
8 | | - ************************************************************************************ |
9 | | -*/ |
10 | | - |
11 | | -#include <linux/delay.h> |
12 | | - |
13 | | -#include "ams_i2c.h" |
14 | | - |
15 | | -int i2c_read(struct i2c_client *client, char reg, char *buf, int len) |
16 | | -{ |
17 | | - struct i2c_msg msgs[2]; // send client address and read command |
18 | | - int ret; |
19 | | - |
20 | | - msgs[0].flags = 0; |
21 | | - msgs[0].addr = client->addr; |
22 | | - msgs[0].len = 1; |
23 | | - msgs[0].buf = ® |
24 | | - |
25 | | - msgs[1].flags = I2C_M_RD; |
26 | | - msgs[1].addr = client->addr; |
27 | | - msgs[1].len = len; |
28 | | - msgs[1].buf = buf; |
29 | | - |
30 | | - ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs)); |
31 | | - |
32 | | - if (ret < 0) { |
33 | | - dev_err(&client->dev, "read: i2c_transfer failed: %d msg_len: %u", ret, len); |
34 | | - } |
35 | | - if (ret != ARRAY_SIZE(msgs)) { |
36 | | - dev_err(&client->dev, "read: i2c_transfer failed: exp: %d msg_len: %d", ARRAY_SIZE(msgs), ret); |
37 | | - ret = -EIO; |
38 | | - } |
39 | | - |
40 | | - return (ret < 0) ? ret : 0; |
41 | | - |
42 | | -} |
43 | | - |
44 | | -int i2c_write(struct i2c_client *client, char reg, const char *buf, int len) |
45 | | -{ |
46 | | - unsigned char *addr_buf; |
47 | | - struct i2c_msg msg; |
48 | | - int ret; |
49 | | - |
50 | | - addr_buf = kmalloc(len + 1, GFP_KERNEL); |
51 | | - if (!addr_buf) |
52 | | - return -ENOMEM; |
53 | | - |
54 | | - addr_buf[0] = reg; |
55 | | - memcpy(&addr_buf[1], buf, len); |
56 | | - msg.flags = 0; |
57 | | - msg.addr = client->addr; |
58 | | - msg.buf = addr_buf; |
59 | | - msg.len = len + 1; |
60 | | - |
61 | | - ret = i2c_transfer(client->adapter, &msg, 1); |
62 | | - |
63 | | - if (ret != 1) { |
64 | | - dev_err(&client->dev, "write: i2c_transfer failed: %d msg_len: %u", ret, len); |
65 | | - ret = -EIO; |
66 | | - } |
67 | | - |
68 | | - kfree(addr_buf); |
69 | | - return (ret < 0) ? ret : 0; |
70 | | -} |
71 | | - |
72 | | -int i2c_write_mask(struct i2c_client *client, char reg, char val, char mask) |
73 | | -{ |
74 | | - int ret; |
75 | | - unsigned char temp; |
76 | | - |
77 | | - ret = i2c_read(client, reg, &temp, 1); |
78 | | - temp &= ~mask; |
79 | | - val &= mask; |
80 | | - temp |= val; |
81 | | - ret = i2c_write(client, reg, &temp, 1); |
82 | | - |
83 | | - return ret; |
84 | | -} |
85 | | - |
86 | | -int i2c_get_register(struct i2c_client *client, char reg, char *value) |
87 | | -{ |
88 | | - return i2c_read(client, reg, value, sizeof(char)); |
89 | | -} |
90 | | - |
91 | | -int i2c_set_register(struct i2c_client *client, char reg, const char value) |
92 | | -{ |
93 | | - return i2c_write(client, reg, &value, sizeof(char)); |
94 | | -} |
| 1 | +/* |
| 2 | + ************************************************************************************ |
| 3 | + * Copyright (c) [2025] ams-OSRAM AG * |
| 4 | + * * |
| 5 | + * SPDX-License-Identifier: GPL-2.0 OR MIT * |
| 6 | + * * |
| 7 | + * For the full license texts, see LICENSES-GPL-2.0.txt or LICENSES-MIT.TXT. * |
| 8 | + ************************************************************************************ |
| 9 | +*/ |
| 10 | + |
| 11 | +#include <linux/delay.h> |
| 12 | + |
| 13 | +#include "ams_i2c.h" |
| 14 | + |
| 15 | +int i2c_read(struct i2c_client *client, char reg, char *buf, int len) |
| 16 | +{ |
| 17 | + struct i2c_msg msgs[2]; // send client address and read command |
| 18 | + int ret; |
| 19 | + |
| 20 | + msgs[0].flags = 0; |
| 21 | + msgs[0].addr = client->addr; |
| 22 | + msgs[0].len = 1; |
| 23 | + msgs[0].buf = ® |
| 24 | + |
| 25 | + msgs[1].flags = I2C_M_RD; |
| 26 | + msgs[1].addr = client->addr; |
| 27 | + msgs[1].len = len; |
| 28 | + msgs[1].buf = buf; |
| 29 | + |
| 30 | + ret = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs)); |
| 31 | + |
| 32 | + if (ret < 0) { |
| 33 | + dev_err(&client->dev, "read: i2c_transfer failed: %d msg_len: %u", ret, len); |
| 34 | + } |
| 35 | + if (ret != ARRAY_SIZE(msgs)) { |
| 36 | + dev_err(&client->dev, "read: i2c_transfer failed: exp: %d msg_len: %d", ARRAY_SIZE(msgs), ret); |
| 37 | + ret = -EIO; |
| 38 | + } |
| 39 | + |
| 40 | + return (ret < 0) ? ret : 0; |
| 41 | + |
| 42 | +} |
| 43 | + |
| 44 | +int i2c_write(struct i2c_client *client, char reg, const char *buf, int len) |
| 45 | +{ |
| 46 | + unsigned char *addr_buf; |
| 47 | + struct i2c_msg msg; |
| 48 | + int ret; |
| 49 | + |
| 50 | + addr_buf = kmalloc(len + 1, GFP_KERNEL); |
| 51 | + if (!addr_buf) |
| 52 | + return -ENOMEM; |
| 53 | + |
| 54 | + addr_buf[0] = reg; |
| 55 | + memcpy(&addr_buf[1], buf, len); |
| 56 | + msg.flags = 0; |
| 57 | + msg.addr = client->addr; |
| 58 | + msg.buf = addr_buf; |
| 59 | + msg.len = len + 1; |
| 60 | + |
| 61 | + ret = i2c_transfer(client->adapter, &msg, 1); |
| 62 | + |
| 63 | + if (ret != 1) { |
| 64 | + dev_err(&client->dev, "write: i2c_transfer failed: %d msg_len: %u", ret, len); |
| 65 | + ret = -EIO; |
| 66 | + } |
| 67 | + |
| 68 | + kfree(addr_buf); |
| 69 | + return (ret < 0) ? ret : 0; |
| 70 | +} |
| 71 | + |
| 72 | +int i2c_write_mask(struct i2c_client *client, char reg, char val, char mask) |
| 73 | +{ |
| 74 | + int ret; |
| 75 | + unsigned char temp; |
| 76 | + |
| 77 | + ret = i2c_read(client, reg, &temp, 1); |
| 78 | + temp &= ~mask; |
| 79 | + val &= mask; |
| 80 | + temp |= val; |
| 81 | + ret = i2c_write(client, reg, &temp, 1); |
| 82 | + |
| 83 | + return ret; |
| 84 | +} |
| 85 | + |
| 86 | +int i2c_get_register(struct i2c_client *client, char reg, char *value) |
| 87 | +{ |
| 88 | + return i2c_read(client, reg, value, sizeof(char)); |
| 89 | +} |
| 90 | + |
| 91 | +int i2c_set_register(struct i2c_client *client, char reg, const char value) |
| 92 | +{ |
| 93 | + return i2c_write(client, reg, &value, sizeof(char)); |
| 94 | +} |
0 commit comments