diff options
author | bgardner@wabtec.com <bgardner@wabtec.com> | 2005-07-12 14:21:11 -0400 |
---|---|---|
committer | Greg Kroah-Hartman <gregkh@suse.de> | 2005-09-05 12:14:03 -0400 |
commit | bc769ff8f5f6e3d249bfde082653e5bf1c2b5698 (patch) | |
tree | c37b4ad67525591ec2df4fa54e61d348d44306f7 /drivers/i2c/chips | |
parent | da1f136c26d45c57e8b2d711bf17a6e5ec4de2d1 (diff) |
[PATCH] I2C: simplify max6875 driver
This is an update to the max6875 driver.
It no longer does any detection, so the address must be forced on module load.
It only makes available the user EEPROM (read-only).
This patch is based off 2.6.13-rc2-mm2.
Signed-off-by: Ben Gardner <bgardner@wabtec.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
Diffstat (limited to 'drivers/i2c/chips')
-rw-r--r-- | drivers/i2c/chips/max6875.c | 445 |
1 files changed, 123 insertions, 322 deletions
diff --git a/drivers/i2c/chips/max6875.c b/drivers/i2c/chips/max6875.c index 0230375f72e5..4d4ace4b805f 100644 --- a/drivers/i2c/chips/max6875.c +++ b/drivers/i2c/chips/max6875.c | |||
@@ -5,97 +5,62 @@ | |||
5 | 5 | ||
6 | Based on i2c/chips/eeprom.c | 6 | Based on i2c/chips/eeprom.c |
7 | 7 | ||
8 | The MAX6875 has two EEPROM sections: config and user. | 8 | The MAX6875 has a bank of registers and two banks of EEPROM. |
9 | At reset, the config EEPROM is read into the registers. | 9 | Address ranges are defined as follows: |
10 | * 0x0000 - 0x0046 = configuration registers | ||
11 | * 0x8000 - 0x8046 = configuration EEPROM | ||
12 | * 0x8100 - 0x82FF = user EEPROM | ||
10 | 13 | ||
11 | This driver make 3 binary files available in sysfs: | 14 | This driver makes the user EEPROM available for read. |
12 | reg_config - direct access to the registers | ||
13 | eeprom_config - acesses configuration eeprom space | ||
14 | eeprom_user - free for application use | ||
15 | 15 | ||
16 | In our application, we put device serial & model numbers in user eeprom. | 16 | The registers & config EEPROM should be accessed via i2c-dev. |
17 | 17 | ||
18 | Notes: | 18 | The MAX6875 ignores the lowest address bit, so each chip responds to |
19 | 1) The datasheet says that register 0x44 / EEPROM 0x8044 should NOT | 19 | two addresses - 0x50/0x51 and 0x52/0x53. |
20 | be overwritten, so the driver explicitly prevents that. | 20 | |
21 | 2) It's a good idea to keep the config (0x45) locked in config EEPROM. | 21 | Note that the MAX6875 uses i2c_smbus_write_byte_data() to set the read |
22 | You can temporarily enable config writes by changing register 0x45. | 22 | address, so this driver is destructive if loaded for the wrong EEPROM chip. |
23 | 23 | ||
24 | This program is free software; you can redistribute it and/or modify | 24 | This program is free software; you can redistribute it and/or modify |
25 | it under the terms of the GNU General Public License as published by | 25 | it under the terms of the GNU General Public License as published by |
26 | the Free Software Foundation; version 2 of the License. | 26 | the Free Software Foundation; version 2 of the License. |
27 | */ | 27 | */ |
28 | 28 | ||
29 | #include <linux/config.h> | ||
30 | #include <linux/kernel.h> | 29 | #include <linux/kernel.h> |
31 | #include <linux/init.h> | 30 | #include <linux/init.h> |
32 | #include <linux/module.h> | 31 | #include <linux/module.h> |
33 | #include <linux/slab.h> | 32 | #include <linux/slab.h> |
34 | #include <linux/sched.h> | ||
35 | #include <linux/delay.h> | ||
36 | #include <linux/i2c.h> | 33 | #include <linux/i2c.h> |
37 | #include <linux/i2c-sensor.h> | 34 | #include <linux/i2c-sensor.h> |
35 | #include <asm/semaphore.h> | ||
38 | 36 | ||
39 | /* Addresses to scan */ | 37 | /* Do not scan - the MAX6875 access method will write to some EEPROM chips */ |
40 | /* No address scanned by default, as this could corrupt standard EEPROMS. */ | ||
41 | static unsigned short normal_i2c[] = {I2C_CLIENT_END}; | 38 | static unsigned short normal_i2c[] = {I2C_CLIENT_END}; |
42 | static unsigned int normal_isa[] = {I2C_CLIENT_ISA_END}; | 39 | static unsigned int normal_isa[] = {I2C_CLIENT_ISA_END}; |
43 | 40 | ||
44 | /* Insmod parameters */ | 41 | /* Insmod parameters */ |
45 | SENSORS_INSMOD_1(max6875); | 42 | SENSORS_INSMOD_1(max6875); |
46 | 43 | ||
47 | /* this param will prevent 'accidental' writes to the eeprom */ | ||
48 | static int allow_write = 0; | ||
49 | module_param(allow_write, int, 0); | ||
50 | MODULE_PARM_DESC(allow_write, | ||
51 | "Enable write access:\n" | ||
52 | "*0: Read only\n" | ||
53 | " 1: Read/Write access"); | ||
54 | |||
55 | /* The MAX6875 can only read/write 16 bytes at a time */ | 44 | /* The MAX6875 can only read/write 16 bytes at a time */ |
56 | #define SLICE_SIZE 16 | 45 | #define SLICE_SIZE 16 |
57 | #define SLICE_BITS 4 | 46 | #define SLICE_BITS 4 |
58 | 47 | ||
59 | /* CONFIG EEPROM is at addresses 0x8000 - 0x8045, registers are at 0 - 0x45 */ | ||
60 | #define CONFIG_EEPROM_BASE 0x8000 | ||
61 | #define CONFIG_EEPROM_SIZE 0x0046 | ||
62 | #define CONFIG_EEPROM_SLICES 5 | ||
63 | |||
64 | /* USER EEPROM is at addresses 0x8100 - 0x82FF */ | 48 | /* USER EEPROM is at addresses 0x8100 - 0x82FF */ |
65 | #define USER_EEPROM_BASE 0x8100 | 49 | #define USER_EEPROM_BASE 0x8100 |
66 | #define USER_EEPROM_SIZE 0x0200 | 50 | #define USER_EEPROM_SIZE 0x0200 |
67 | #define USER_EEPROM_SLICES 32 | 51 | #define USER_EEPROM_SLICES 32 |
68 | 52 | ||
69 | /* MAX6875 commands */ | 53 | /* MAX6875 commands */ |
70 | #define MAX6875_CMD_BLOCK_WRITE 0x83 | 54 | #define MAX6875_CMD_BLK_READ 0x84 |
71 | #define MAX6875_CMD_BLOCK_READ 0x84 | ||
72 | #define MAX6875_CMD_REBOOT 0x88 | ||
73 | |||
74 | enum max6875_area_type { | ||
75 | max6875_register_config=0, | ||
76 | max6875_eeprom_config, | ||
77 | max6875_eeprom_user, | ||
78 | max6857_max | ||
79 | }; | ||
80 | |||
81 | struct eeprom_block { | ||
82 | enum max6875_area_type type; | ||
83 | u8 slices; | ||
84 | u32 size; | ||
85 | u32 valid; | ||
86 | u32 base; | ||
87 | unsigned long *updated; | ||
88 | u8 *data; | ||
89 | }; | ||
90 | 55 | ||
91 | /* Each client has this additional data */ | 56 | /* Each client has this additional data */ |
92 | struct max6875_data { | 57 | struct max6875_data { |
93 | struct i2c_client client; | 58 | struct i2c_client client; |
94 | struct semaphore update_lock; | 59 | struct semaphore update_lock; |
95 | struct eeprom_block blocks[max6857_max]; | 60 | |
96 | /* the above structs point into the arrays below */ | 61 | u32 valid; |
97 | u8 data[USER_EEPROM_SIZE + (CONFIG_EEPROM_SIZE*2)]; | 62 | u8 data[USER_EEPROM_SIZE]; |
98 | unsigned long last_updated[USER_EEPROM_SLICES + (CONFIG_EEPROM_SLICES*2)]; | 63 | unsigned long last_updated[USER_EEPROM_SLICES]; |
99 | }; | 64 | }; |
100 | 65 | ||
101 | static int max6875_attach_adapter(struct i2c_adapter *adapter); | 66 | static int max6875_attach_adapter(struct i2c_adapter *adapter); |
@@ -111,224 +76,98 @@ static struct i2c_driver max6875_driver = { | |||
111 | .detach_client = max6875_detach_client, | 76 | .detach_client = max6875_detach_client, |
112 | }; | 77 | }; |
113 | 78 | ||
114 | static int max6875_update_slice(struct i2c_client *client, | 79 | static void max6875_update_slice(struct i2c_client *client, int slice) |
115 | struct eeprom_block *blk, | ||
116 | int slice) | ||
117 | { | 80 | { |
118 | struct max6875_data *data = i2c_get_clientdata(client); | 81 | struct max6875_data *data = i2c_get_clientdata(client); |
119 | int i, j, addr, count; | 82 | int i, j, addr; |
120 | u8 rdbuf[SLICE_SIZE]; | 83 | u8 *buf; |
121 | int retval = 0; | 84 | int retval = 0; |
122 | 85 | ||
123 | if (slice >= blk->slices) | 86 | if (slice >= USER_EEPROM_SLICES) |
124 | return -1; | 87 | return; |
125 | 88 | ||
126 | down(&data->update_lock); | 89 | down(&data->update_lock); |
127 | 90 | ||
128 | if (!(blk->valid & (1 << slice)) || | 91 | buf = &data->data[slice << SLICE_BITS]; |
129 | (jiffies - blk->updated[slice] > 300 * HZ) || | 92 | |
130 | (jiffies < blk->updated[slice])) { | 93 | if (!(data->valid & (1 << slice)) || |
131 | dev_dbg(&client->dev, "Starting eeprom update, slice %u, base %u\n", | 94 | time_after(jiffies, data->last_updated[slice])) { |
95 | |||
96 | dev_dbg(&client->dev, "Starting update of slice %u\n", | ||
132 | slice, blk->base); | 97 | slice, blk->base); |
133 | 98 | ||
134 | addr = blk->base + (slice << SLICE_BITS); | 99 | data->valid &= ~(1 << slice); |
135 | count = blk->size - (slice << SLICE_BITS); | ||
136 | if (count > SLICE_SIZE) { | ||
137 | count = SLICE_SIZE; | ||
138 | } | ||
139 | 100 | ||
140 | /* Preset the read address */ | 101 | addr = USER_EEPROM_BASE + (slice << SLICE_BITS); |
141 | if (addr < 0x100) { | 102 | |
142 | /* select the register */ | 103 | /* select the eeprom address */ |
143 | if (i2c_smbus_write_byte(client, addr & 0xFF)) { | 104 | if (i2c_smbus_write_byte_data(client, addr >> 8, addr & 0xFF)) { |
144 | dev_dbg(&client->dev, "max6875 register select has failed!\n"); | 105 | dev_err(&client->dev, "address set failed\n"); |
145 | retval = -1; | 106 | retval = -1; |
146 | goto exit; | 107 | goto exit_up; |
147 | } | ||
148 | } else { | ||
149 | /* select the eeprom */ | ||
150 | if (i2c_smbus_write_byte_data(client, addr >> 8, addr & 0xFF)) { | ||
151 | dev_dbg(&client->dev, "max6875 address set has failed!\n"); | ||
152 | retval = -1; | ||
153 | goto exit; | ||
154 | } | ||
155 | } | 108 | } |
156 | 109 | ||
157 | if (i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_READ_I2C_BLOCK)) { | 110 | if (i2c_check_functionality(client->adapter, |
158 | if (i2c_smbus_read_i2c_block_data(client, MAX6875_CMD_BLOCK_READ, | 111 | I2C_FUNC_SMBUS_READ_I2C_BLOCK)) { |
159 | rdbuf) != SLICE_SIZE) | 112 | if (i2c_smbus_read_i2c_block_data(client, |
160 | { | 113 | MAX6875_CMD_BLK_READ, |
114 | buf) != SLICE_SIZE) { | ||
161 | retval = -1; | 115 | retval = -1; |
162 | goto exit; | 116 | goto exit_up; |
163 | } | 117 | } |
164 | |||
165 | memcpy(&blk->data[slice << SLICE_BITS], rdbuf, count); | ||
166 | } else { | 118 | } else { |
167 | for (i = 0; i < count; i++) { | 119 | for (i = 0; i < SLICE_SIZE; i++) { |
168 | j = i2c_smbus_read_byte(client); | 120 | j = i2c_smbus_read_byte(client); |
169 | if (j < 0) | 121 | if (j < 0) { |
170 | { | ||
171 | retval = -1; | 122 | retval = -1; |
172 | goto exit; | 123 | goto exit_up; |
173 | } | 124 | } |
174 | blk->data[(slice << SLICE_BITS) + i] = (u8) j; | 125 | buf[i] = j; |
175 | } | 126 | } |
176 | } | 127 | } |
177 | blk->updated[slice] = jiffies; | 128 | data->last_updated[slice] = jiffies; |
178 | blk->valid |= (1 << slice); | 129 | data->valid |= (1 << slice); |
179 | } | 130 | } |
180 | exit: | 131 | exit_up: |
181 | up(&data->update_lock); | 132 | up(&data->update_lock); |
182 | return retval; | ||
183 | } | ||
184 | |||
185 | static ssize_t max6875_read(struct kobject *kobj, char *buf, loff_t off, size_t count, | ||
186 | enum max6875_area_type area_type) | ||
187 | { | ||
188 | struct i2c_client *client = to_i2c_client(container_of(kobj, struct device, kobj)); | ||
189 | struct max6875_data *data = i2c_get_clientdata(client); | ||
190 | struct eeprom_block *blk; | ||
191 | int slice; | ||
192 | |||
193 | blk = &data->blocks[area_type]; | ||
194 | |||
195 | if (off > blk->size) | ||
196 | return 0; | ||
197 | if (off + count > blk->size) | ||
198 | count = blk->size - off; | ||
199 | |||
200 | /* Only refresh slices which contain requested bytes */ | ||
201 | for (slice = (off >> SLICE_BITS); slice <= ((off + count - 1) >> SLICE_BITS); slice++) | ||
202 | max6875_update_slice(client, blk, slice); | ||
203 | |||
204 | memcpy(buf, &blk->data[off], count); | ||
205 | |||
206 | return count; | ||
207 | } | ||
208 | |||
209 | static ssize_t max6875_user_read(struct kobject *kobj, char *buf, loff_t off, size_t count) | ||
210 | { | ||
211 | return max6875_read(kobj, buf, off, count, max6875_eeprom_user); | ||
212 | } | 133 | } |
213 | 134 | ||
214 | static ssize_t max6875_config_read(struct kobject *kobj, char *buf, loff_t off, size_t count) | 135 | static inline struct i2c_client *kobj_to_i2c_client(struct kobject *kobj) |
215 | { | 136 | { |
216 | return max6875_read(kobj, buf, off, count, max6875_eeprom_config); | 137 | return to_i2c_client(container_of(kobj, struct device, kobj)); |
217 | } | 138 | } |
218 | 139 | ||
219 | static ssize_t max6875_cfgreg_read(struct kobject *kobj, char *buf, loff_t off, size_t count) | 140 | static ssize_t max6875_read(struct kobject *kobj, char *buf, loff_t off, |
141 | size_t count) | ||
220 | { | 142 | { |
221 | return max6875_read(kobj, buf, off, count, max6875_register_config); | 143 | struct i2c_client *client = kobj_to_i2c_client(kobj); |
222 | } | ||
223 | |||
224 | |||
225 | static ssize_t max6875_write(struct kobject *kobj, char *buf, loff_t off, size_t count, | ||
226 | enum max6875_area_type area_type) | ||
227 | { | ||
228 | struct i2c_client *client = to_i2c_client(container_of(kobj, struct device, kobj)); | ||
229 | struct max6875_data *data = i2c_get_clientdata(client); | 144 | struct max6875_data *data = i2c_get_clientdata(client); |
230 | struct eeprom_block *blk; | 145 | int slice, max_slice; |
231 | int slice, addr, retval; | ||
232 | ssize_t sent = 0; | ||
233 | |||
234 | blk = &data->blocks[area_type]; | ||
235 | 146 | ||
236 | if (off > blk->size) | 147 | if (off > USER_EEPROM_SIZE) |
237 | return 0; | 148 | return 0; |
238 | if ((off + count) > blk->size) | ||
239 | count = blk->size - off; | ||
240 | 149 | ||
241 | if (down_interruptible(&data->update_lock)) | 150 | if (off + count > USER_EEPROM_SIZE) |
242 | return -EAGAIN; | 151 | count = USER_EEPROM_SIZE - off; |
243 | 152 | ||
244 | /* writing to a register is done with i2c_smbus_write_byte_data() */ | 153 | /* refresh slices which contain requested bytes */ |
245 | if (blk->type == max6875_register_config) { | 154 | max_slice = (off + count - 1) >> SLICE_BITS; |
246 | for (sent = 0; sent < count; sent++) { | 155 | for (slice = (off >> SLICE_BITS); slice <= max_slice; slice++) |
247 | addr = off + sent; | 156 | max6875_update_slice(client, slice); |
248 | if (addr == 0x44) | ||
249 | continue; | ||
250 | 157 | ||
251 | retval = i2c_smbus_write_byte_data(client, addr, buf[sent]); | 158 | memcpy(buf, &data->data[off], count); |
252 | } | ||
253 | } else { | ||
254 | int cmd, val; | ||
255 | |||
256 | /* We are writing to EEPROM */ | ||
257 | for (sent = 0; sent < count; sent++) { | ||
258 | addr = blk->base + off + sent; | ||
259 | cmd = addr >> 8; | ||
260 | val = (addr & 0xff) | (buf[sent] << 8); // reversed | ||
261 | |||
262 | if (addr == 0x8044) | ||
263 | continue; | ||
264 | |||
265 | retval = i2c_smbus_write_word_data(client, cmd, val); | ||
266 | |||
267 | if (retval) { | ||
268 | goto error_exit; | ||
269 | } | ||
270 | 159 | ||
271 | /* A write takes up to 11 ms */ | 160 | return count; |
272 | msleep(11); | ||
273 | } | ||
274 | } | ||
275 | |||
276 | /* Invalidate the scratch buffer */ | ||
277 | for (slice = (off >> SLICE_BITS); slice <= ((off + count - 1) >> SLICE_BITS); slice++) | ||
278 | blk->valid &= ~(1 << slice); | ||
279 | |||
280 | error_exit: | ||
281 | up(&data->update_lock); | ||
282 | |||
283 | return sent; | ||
284 | } | ||
285 | |||
286 | static ssize_t max6875_user_write(struct kobject *kobj, char *buf, loff_t off, size_t count) | ||
287 | { | ||
288 | return max6875_write(kobj, buf, off, count, max6875_eeprom_user); | ||
289 | } | ||
290 | |||
291 | static ssize_t max6875_config_write(struct kobject *kobj, char *buf, loff_t off, size_t count) | ||
292 | { | ||
293 | return max6875_write(kobj, buf, off, count, max6875_eeprom_config); | ||
294 | } | ||
295 | |||
296 | static ssize_t max6875_cfgreg_write(struct kobject *kobj, char *buf, loff_t off, size_t count) | ||
297 | { | ||
298 | return max6875_write(kobj, buf, off, count, max6875_register_config); | ||
299 | } | 161 | } |
300 | 162 | ||
301 | static struct bin_attribute user_eeprom_attr = { | 163 | static struct bin_attribute user_eeprom_attr = { |
302 | .attr = { | 164 | .attr = { |
303 | .name = "eeprom_user", | 165 | .name = "eeprom", |
304 | .mode = S_IRUGO | S_IWUSR | S_IWGRP, | 166 | .mode = S_IRUGO, |
305 | .owner = THIS_MODULE, | 167 | .owner = THIS_MODULE, |
306 | }, | 168 | }, |
307 | .size = USER_EEPROM_SIZE, | 169 | .size = USER_EEPROM_SIZE, |
308 | .read = max6875_user_read, | 170 | .read = max6875_read, |
309 | .write = max6875_user_write, | ||
310 | }; | ||
311 | |||
312 | static struct bin_attribute config_eeprom_attr = { | ||
313 | .attr = { | ||
314 | .name = "eeprom_config", | ||
315 | .mode = S_IRUGO | S_IWUSR, | ||
316 | .owner = THIS_MODULE, | ||
317 | }, | ||
318 | .size = CONFIG_EEPROM_SIZE, | ||
319 | .read = max6875_config_read, | ||
320 | .write = max6875_config_write, | ||
321 | }; | ||
322 | |||
323 | static struct bin_attribute config_register_attr = { | ||
324 | .attr = { | ||
325 | .name = "reg_config", | ||
326 | .mode = S_IRUGO | S_IWUSR, | ||
327 | .owner = THIS_MODULE, | ||
328 | }, | ||
329 | .size = CONFIG_EEPROM_SIZE, | ||
330 | .read = max6875_cfgreg_read, | ||
331 | .write = max6875_cfgreg_write, | ||
332 | }; | 171 | }; |
333 | 172 | ||
334 | static int max6875_attach_adapter(struct i2c_adapter *adapter) | 173 | static int max6875_attach_adapter(struct i2c_adapter *adapter) |
@@ -339,109 +178,73 @@ static int max6875_attach_adapter(struct i2c_adapter *adapter) | |||
339 | /* This function is called by i2c_detect */ | 178 | /* This function is called by i2c_detect */ |
340 | static int max6875_detect(struct i2c_adapter *adapter, int address, int kind) | 179 | static int max6875_detect(struct i2c_adapter *adapter, int address, int kind) |
341 | { | 180 | { |
342 | struct i2c_client *new_client; | 181 | struct i2c_client *real_client; |
182 | struct i2c_client *fake_client; | ||
343 | struct max6875_data *data; | 183 | struct max6875_data *data; |
344 | int err = 0; | 184 | int err = 0; |
345 | 185 | ||
346 | /* Prevent 24RF08 corruption (in case of user error) */ | 186 | /* Prevent 24rf08 corruption (in case of user error) */ |
347 | if (kind < 0) | 187 | if (kind < 0) |
348 | i2c_smbus_xfer(adapter, address, 0, 0, 0, | 188 | i2c_smbus_xfer(adapter, address, 0, 0, 0, |
349 | I2C_SMBUS_QUICK, NULL); | 189 | I2C_SMBUS_QUICK, NULL); |
350 | 190 | ||
351 | /* There are three ways we can read the EEPROM data: | 191 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA |
352 | (1) I2C block reads (faster, but unsupported by most adapters) | 192 | | I2C_FUNC_SMBUS_READ_BYTE)) |
353 | (2) Consecutive byte reads (100% overhead) | 193 | return 0; |
354 | (3) Regular byte data reads (200% overhead) | 194 | |
355 | The third method is not implemented by this driver because all | 195 | /* Only check even addresses */ |
356 | known adapters support at least the second. */ | 196 | if (address & 1) |
357 | if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_READ_BYTE_DATA | | 197 | return 0; |
358 | I2C_FUNC_SMBUS_BYTE | | 198 | |
359 | I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) | 199 | if (!(data = kmalloc(sizeof(struct max6875_data), GFP_KERNEL))) |
360 | goto exit; | 200 | return -ENOMEM; |
361 | |||
362 | /* OK. For now, we presume we have a valid client. We now create the | ||
363 | client structure, even though we cannot fill it completely yet. | ||
364 | But it allows us to access eeprom_{read,write}_value. */ | ||
365 | if (!(data = kmalloc(sizeof(struct max6875_data), GFP_KERNEL))) { | ||
366 | err = -ENOMEM; | ||
367 | goto exit; | ||
368 | } | ||
369 | memset(data, 0, sizeof(struct max6875_data)); | 201 | memset(data, 0, sizeof(struct max6875_data)); |
370 | 202 | ||
371 | new_client = &data->client; | 203 | /* A fake client is created on the odd address */ |
372 | i2c_set_clientdata(new_client, data); | 204 | if (!(fake_client = kmalloc(sizeof(struct i2c_client), GFP_KERNEL))) { |
373 | new_client->addr = address; | 205 | err = -ENOMEM; |
374 | new_client->adapter = adapter; | 206 | goto exit_kfree1; |
375 | new_client->driver = &max6875_driver; | 207 | } |
376 | new_client->flags = 0; | 208 | memset(fake_client, 0, sizeof(struct i2c_client)); |
377 | 209 | ||
378 | /* Setup the user section */ | 210 | /* Init real i2c_client */ |
379 | data->blocks[max6875_eeprom_user].type = max6875_eeprom_user; | 211 | real_client = &data->client; |
380 | data->blocks[max6875_eeprom_user].slices = USER_EEPROM_SLICES; | 212 | i2c_set_clientdata(real_client, data); |
381 | data->blocks[max6875_eeprom_user].size = USER_EEPROM_SIZE; | 213 | real_client->addr = address; |
382 | data->blocks[max6875_eeprom_user].base = USER_EEPROM_BASE; | 214 | real_client->adapter = adapter; |
383 | data->blocks[max6875_eeprom_user].data = data->data; | 215 | real_client->driver = &max6875_driver; |
384 | data->blocks[max6875_eeprom_user].updated = data->last_updated; | 216 | real_client->flags = 0; |
385 | 217 | strlcpy(real_client->name, "max6875", I2C_NAME_SIZE); | |
386 | /* Setup the config section */ | ||
387 | data->blocks[max6875_eeprom_config].type = max6875_eeprom_config; | ||
388 | data->blocks[max6875_eeprom_config].slices = CONFIG_EEPROM_SLICES; | ||
389 | data->blocks[max6875_eeprom_config].size = CONFIG_EEPROM_SIZE; | ||
390 | data->blocks[max6875_eeprom_config].base = CONFIG_EEPROM_BASE; | ||
391 | data->blocks[max6875_eeprom_config].data = &data->data[USER_EEPROM_SIZE]; | ||
392 | data->blocks[max6875_eeprom_config].updated = &data->last_updated[USER_EEPROM_SLICES]; | ||
393 | |||
394 | /* Setup the register section */ | ||
395 | data->blocks[max6875_register_config].type = max6875_register_config; | ||
396 | data->blocks[max6875_register_config].slices = CONFIG_EEPROM_SLICES; | ||
397 | data->blocks[max6875_register_config].size = CONFIG_EEPROM_SIZE; | ||
398 | data->blocks[max6875_register_config].base = 0; | ||
399 | data->blocks[max6875_register_config].data = &data->data[USER_EEPROM_SIZE+CONFIG_EEPROM_SIZE]; | ||
400 | data->blocks[max6875_register_config].updated = &data->last_updated[USER_EEPROM_SLICES+CONFIG_EEPROM_SLICES]; | ||
401 | |||
402 | /* Init the data */ | ||
403 | memset(data->data, 0xff, sizeof(data->data)); | ||
404 | |||
405 | /* Fill in the remaining client fields */ | ||
406 | strlcpy(new_client->name, "max6875", I2C_NAME_SIZE); | ||
407 | init_MUTEX(&data->update_lock); | 218 | init_MUTEX(&data->update_lock); |
408 | 219 | ||
409 | /* Verify that the chip is really what we think it is */ | 220 | /* Init fake client data */ |
410 | if ((max6875_update_slice(new_client, &data->blocks[max6875_eeprom_config], 4) < 0) || | 221 | /* set the client data to the i2c_client so that it will get freed */ |
411 | (max6875_update_slice(new_client, &data->blocks[max6875_register_config], 4) < 0)) | 222 | i2c_set_clientdata(fake_client, fake_client); |
412 | goto exit_kfree; | 223 | fake_client->addr = address | 1; |
413 | 224 | fake_client->adapter = adapter; | |
414 | /* 0x41,0x42 must be zero and 0x40 must match in eeprom and registers */ | 225 | fake_client->driver = &max6875_driver; |
415 | if ((data->blocks[max6875_eeprom_config].data[0x41] != 0) || | 226 | fake_client->flags = 0; |
416 | (data->blocks[max6875_eeprom_config].data[0x42] != 0) || | 227 | strlcpy(fake_client->name, "max6875-dummy", I2C_NAME_SIZE); |
417 | (data->blocks[max6875_register_config].data[0x41] != 0) || | 228 | |
418 | (data->blocks[max6875_register_config].data[0x42] != 0) || | 229 | /* Prevent 24RF08 corruption (in case of user error) */ |
419 | (data->blocks[max6875_eeprom_config].data[0x40] != | 230 | i2c_smbus_write_quick(real_client, 0); |
420 | data->blocks[max6875_register_config].data[0x40])) | 231 | |
421 | goto exit_kfree; | 232 | if ((err = i2c_attach_client(real_client)) != 0) |
422 | 233 | goto exit_kfree2; | |
423 | /* Tell the I2C layer a new client has arrived */ | 234 | |
424 | if ((err = i2c_attach_client(new_client))) | 235 | if ((err = i2c_attach_client(fake_client)) != 0) |
425 | goto exit_kfree; | 236 | goto exit_detach; |
426 | 237 | ||
427 | /* create the sysfs eeprom files with the correct permissions */ | 238 | sysfs_create_bin_file(&real_client->dev.kobj, &user_eeprom_attr); |
428 | if (allow_write == 0) { | ||
429 | user_eeprom_attr.attr.mode &= ~S_IWUGO; | ||
430 | user_eeprom_attr.write = NULL; | ||
431 | config_eeprom_attr.attr.mode &= ~S_IWUGO; | ||
432 | config_eeprom_attr.write = NULL; | ||
433 | config_register_attr.attr.mode &= ~S_IWUGO; | ||
434 | config_register_attr.write = NULL; | ||
435 | } | ||
436 | sysfs_create_bin_file(&new_client->dev.kobj, &user_eeprom_attr); | ||
437 | sysfs_create_bin_file(&new_client->dev.kobj, &config_eeprom_attr); | ||
438 | sysfs_create_bin_file(&new_client->dev.kobj, &config_register_attr); | ||
439 | 239 | ||
440 | return 0; | 240 | return 0; |
441 | 241 | ||
442 | exit_kfree: | 242 | exit_detach: |
243 | i2c_detach_client(real_client); | ||
244 | exit_kfree2: | ||
245 | kfree(fake_client); | ||
246 | exit_kfree1: | ||
443 | kfree(data); | 247 | kfree(data); |
444 | exit: | ||
445 | return err; | 248 | return err; |
446 | } | 249 | } |
447 | 250 | ||
@@ -451,12 +254,10 @@ static int max6875_detach_client(struct i2c_client *client) | |||
451 | 254 | ||
452 | err = i2c_detach_client(client); | 255 | err = i2c_detach_client(client); |
453 | if (err) { | 256 | if (err) { |
454 | dev_err(&client->dev, "Client deregistration failed, client not detached.\n"); | 257 | dev_err(&client->dev, "i2c_detach_client() failed\n"); |
455 | return err; | 258 | return err; |
456 | } | 259 | } |
457 | |||
458 | kfree(i2c_get_clientdata(client)); | 260 | kfree(i2c_get_clientdata(client)); |
459 | |||
460 | return 0; | 261 | return 0; |
461 | } | 262 | } |
462 | 263 | ||