Blame view

drivers/hwmon/sht15.c 29 KB
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1
2
3
  /*
   * sht15.c - support for the SHT15 Temperature and Humidity Sensor
   *
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
4
   * Portions Copyright (c) 2010-2011 Savoir-faire Linux Inc.
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
5
   *          Jerome Oufella <jerome.oufella@savoirfairelinux.com>
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
6
7
   *          Vivien Didelot <vivien.didelot@savoirfairelinux.com>
   *
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
8
9
10
11
12
13
14
15
   * Copyright (c) 2009 Jonathan Cameron
   *
   * Copyright (c) 2007 Wouter Horre
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
   *
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
16
   * For further information, see the Documentation/hwmon/sht15 file.
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
17
18
19
20
21
22
23
24
25
26
27
   */
  
  #include <linux/interrupt.h>
  #include <linux/irq.h>
  #include <linux/gpio.h>
  #include <linux/module.h>
  #include <linux/init.h>
  #include <linux/hwmon.h>
  #include <linux/hwmon-sysfs.h>
  #include <linux/mutex.h>
  #include <linux/platform_device.h>
d43c36dc6   Alexey Dobriyan   headers: remove s...
28
  #include <linux/sched.h>
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
29
30
31
32
33
  #include <linux/delay.h>
  #include <linux/jiffies.h>
  #include <linux/err.h>
  #include <linux/sht15.h>
  #include <linux/regulator/consumer.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
34
  #include <linux/slab.h>
60063497a   Arun Sharma   atomic: use <linu...
35
  #include <linux/atomic.h>
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
36

99a0378de   Vivien Didelot   hwmon: (sht15) ge...
37
38
39
  /* Commands */
  #define SHT15_MEASURE_TEMP		0x03
  #define SHT15_MEASURE_RH		0x05
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
40
41
  #define SHT15_WRITE_STATUS		0x06
  #define SHT15_READ_STATUS		0x07
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
42
  #define SHT15_SOFT_RESET		0x1E
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
43

99a0378de   Vivien Didelot   hwmon: (sht15) ge...
44
45
46
47
  /* Min timings */
  #define SHT15_TSCKL			100	/* (nsecs) clock low */
  #define SHT15_TSCKH			100	/* (nsecs) clock high */
  #define SHT15_TSU			150	/* (nsecs) data setup time */
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
48
  #define SHT15_TSRST			11	/* (msecs) soft reset time */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
49

cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
50
51
52
53
54
  /* Status Register Bits */
  #define SHT15_STATUS_LOW_RESOLUTION	0x01
  #define SHT15_STATUS_NO_OTP_RELOAD	0x02
  #define SHT15_STATUS_HEATER		0x04
  #define SHT15_STATUS_LOW_BATTERY	0x40
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
55
56
57
58
59
60
  /* Actions the driver may be doing */
  enum sht15_state {
  	SHT15_READING_NOTHING,
  	SHT15_READING_TEMP,
  	SHT15_READING_HUMID
  };
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
61
62
  
  /**
25985edce   Lucas De Marchi   Fix common misspe...
63
   * struct sht15_temppair - elements of voltage dependent temp calc
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
64
65
66
67
68
69
70
   * @vdd:	supply voltage in microvolts
   * @d1:		see data sheet
   */
  struct sht15_temppair {
  	int vdd; /* microvolts */
  	int d1;
  };
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
71
  /* Table 9 from datasheet - relates temperature calculation to supply voltage */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
72
73
74
75
76
77
78
  static const struct sht15_temppair temppoints[] = {
  	{ 2500000, -39400 },
  	{ 3000000, -39600 },
  	{ 3500000, -39700 },
  	{ 4000000, -39800 },
  	{ 5000000, -40100 },
  };
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
  /* Table from CRC datasheet, section 2.4 */
  static const u8 sht15_crc8_table[] = {
  	0,	49,	98,	83,	196,	245,	166,	151,
  	185,	136,	219,	234,	125,	76,	31,	46,
  	67,	114,	33,	16,	135,	182,	229,	212,
  	250,	203,	152,	169,	62,	15,	92,	109,
  	134,	183,	228,	213,	66,	115,	32,	17,
  	63,	14,	93,	108,	251,	202,	153,	168,
  	197,	244,	167,	150,	1,	48,	99,	82,
  	124,	77,	30,	47,	184,	137,	218,	235,
  	61,	12,	95,	110,	249,	200,	155,	170,
  	132,	181,	230,	215,	64,	113,	34,	19,
  	126,	79,	28,	45,	186,	139,	216,	233,
  	199,	246,	165,	148,	3,	50,	97,	80,
  	187,	138,	217,	232,	127,	78,	29,	44,
  	2,	51,	96,	81,	198,	247,	164,	149,
  	248,	201,	154,	171,	60,	13,	94,	111,
  	65,	112,	35,	18,	133,	180,	231,	214,
  	122,	75,	24,	41,	190,	143,	220,	237,
  	195,	242,	161,	144,	7,	54,	101,	84,
  	57,	8,	91,	106,	253,	204,	159,	174,
  	128,	177,	226,	211,	68,	117,	38,	23,
  	252,	205,	158,	175,	56,	9,	90,	107,
  	69,	116,	39,	22,	129,	176,	227,	210,
  	191,	142,	221,	236,	123,	74,	25,	40,
  	6,	55,	100,	85,	194,	243,	160,	145,
  	71,	118,	37,	20,	131,	178,	225,	208,
  	254,	207,	156,	173,	58,	11,	88,	105,
  	4,	53,	102,	87,	192,	241,	162,	147,
  	189,	140,	223,	238,	121,	72,	27,	42,
  	193,	240,	163,	146,	5,	52,	103,	86,
  	120,	73,	26,	43,	188,	141,	222,	239,
  	130,	179,	224,	209,	70,	119,	36,	21,
  	59,	10,	89,	104,	255,	206,	157,	172
  };
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
114
115
  /**
   * struct sht15_data - device instance specific data
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
116
117
118
119
120
   * @pdata:		platform data (gpio's etc).
   * @read_work:		bh of interrupt handler.
   * @wait_queue:		wait queue for getting values from device.
   * @val_temp:		last temperature value read from device.
   * @val_humid:		last humidity value read from device.
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
121
   * @val_status:		last status register value read from device.
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
122
123
   * @checksum_ok:	last value read from the device passed CRC validation.
   * @checksumming:	flag used to enable the data validation with CRC.
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
124
125
   * @state:		state identifying the action the driver is doing.
   * @measurements_valid:	are the current stored measures valid (start condition).
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
126
   * @status_valid:	is the current stored status valid (start condition).
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
127
   * @last_measurement:	time of last measure.
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
128
   * @last_status:	time of last status reading.
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
129
130
131
132
133
134
135
136
137
138
139
140
141
   * @read_lock:		mutex to ensure only one read in progress at a time.
   * @dev:		associate device structure.
   * @hwmon_dev:		device associated with hwmon subsystem.
   * @reg:		associated regulator (if specified).
   * @nb:			notifier block to handle notifications of voltage
   *                      changes.
   * @supply_uV:		local copy of supply voltage used to allow use of
   *                      regulator consumer if available.
   * @supply_uV_valid:	indicates that an updated value has not yet been
   *			obtained from the regulator and so any calculations
   *			based upon it will be invalid.
   * @update_supply_work:	work struct that is used to update the supply_uV.
   * @interrupt_handled:	flag used to indicate a handler has been scheduled.
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
142
143
144
145
146
147
148
   */
  struct sht15_data {
  	struct sht15_platform_data	*pdata;
  	struct work_struct		read_work;
  	wait_queue_head_t		wait_queue;
  	uint16_t			val_temp;
  	uint16_t			val_humid;
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
149
  	u8				val_status;
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
150
151
  	bool				checksum_ok;
  	bool				checksumming;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
152
153
  	enum sht15_state		state;
  	bool				measurements_valid;
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
154
  	bool				status_valid;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
155
  	unsigned long			last_measurement;
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
156
  	unsigned long			last_status;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
157
158
159
160
161
162
  	struct mutex			read_lock;
  	struct device			*dev;
  	struct device			*hwmon_dev;
  	struct regulator		*reg;
  	struct notifier_block		nb;
  	int				supply_uV;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
163
  	bool				supply_uV_valid;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
164
165
166
167
168
  	struct work_struct		update_supply_work;
  	atomic_t			interrupt_handled;
  };
  
  /**
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
   * sht15_reverse() - reverse a byte
   * @byte:    byte to reverse.
   */
  static u8 sht15_reverse(u8 byte)
  {
  	u8 i, c;
  
  	for (c = 0, i = 0; i < 8; i++)
  		c |= (!!(byte & (1 << i))) << (7 - i);
  	return c;
  }
  
  /**
   * sht15_crc8() - compute crc8
   * @data:	sht15 specific data.
   * @value:	sht15 retrieved data.
   *
   * This implements section 2 of the CRC datasheet.
   */
  static u8 sht15_crc8(struct sht15_data *data,
  		const u8 *value,
  		int len)
  {
  	u8 crc = sht15_reverse(data->val_status & 0x0F);
  
  	while (len--) {
  		crc = sht15_crc8_table[*value ^ crc];
  		value++;
  	}
  
  	return crc;
  }
  
  /**
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
203
204
205
206
207
208
209
210
   * sht15_connection_reset() - reset the comms interface
   * @data:	sht15 specific data
   *
   * This implements section 3.4 of the data sheet
   */
  static void sht15_connection_reset(struct sht15_data *data)
  {
  	int i;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
211

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
212
213
214
215
216
217
218
219
220
221
222
  	gpio_direction_output(data->pdata->gpio_data, 1);
  	ndelay(SHT15_TSCKL);
  	gpio_set_value(data->pdata->gpio_sck, 0);
  	ndelay(SHT15_TSCKL);
  	for (i = 0; i < 9; ++i) {
  		gpio_set_value(data->pdata->gpio_sck, 1);
  		ndelay(SHT15_TSCKH);
  		gpio_set_value(data->pdata->gpio_sck, 0);
  		ndelay(SHT15_TSCKL);
  	}
  }
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
223

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
224
225
226
227
  /**
   * sht15_send_bit() - send an individual bit to the device
   * @data:	device state data
   * @val:	value of bit to be sent
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
228
   */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
229
230
  static inline void sht15_send_bit(struct sht15_data *data, int val)
  {
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
231
232
233
234
235
236
237
238
239
240
  	gpio_set_value(data->pdata->gpio_data, val);
  	ndelay(SHT15_TSU);
  	gpio_set_value(data->pdata->gpio_sck, 1);
  	ndelay(SHT15_TSCKH);
  	gpio_set_value(data->pdata->gpio_sck, 0);
  	ndelay(SHT15_TSCKL); /* clock low time */
  }
  
  /**
   * sht15_transmission_start() - specific sequence for new transmission
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
241
   * @data:	device state data
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
242
   *
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
243
244
245
   * Timings for this are not documented on the data sheet, so very
   * conservative ones used in implementation. This implements
   * figure 12 on the data sheet.
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
246
   */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
  static void sht15_transmission_start(struct sht15_data *data)
  {
  	/* ensure data is high and output */
  	gpio_direction_output(data->pdata->gpio_data, 1);
  	ndelay(SHT15_TSU);
  	gpio_set_value(data->pdata->gpio_sck, 0);
  	ndelay(SHT15_TSCKL);
  	gpio_set_value(data->pdata->gpio_sck, 1);
  	ndelay(SHT15_TSCKH);
  	gpio_set_value(data->pdata->gpio_data, 0);
  	ndelay(SHT15_TSU);
  	gpio_set_value(data->pdata->gpio_sck, 0);
  	ndelay(SHT15_TSCKL);
  	gpio_set_value(data->pdata->gpio_sck, 1);
  	ndelay(SHT15_TSCKH);
  	gpio_set_value(data->pdata->gpio_data, 1);
  	ndelay(SHT15_TSU);
  	gpio_set_value(data->pdata->gpio_sck, 0);
  	ndelay(SHT15_TSCKL);
  }
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
267

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
268
269
270
271
  /**
   * sht15_send_byte() - send a single byte to the device
   * @data:	device state
   * @byte:	value to be sent
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
272
   */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
273
274
275
  static void sht15_send_byte(struct sht15_data *data, u8 byte)
  {
  	int i;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
276

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
277
278
279
280
281
  	for (i = 0; i < 8; i++) {
  		sht15_send_bit(data, !!(byte & 0x80));
  		byte <<= 1;
  	}
  }
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
282

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
283
284
285
  /**
   * sht15_wait_for_response() - checks for ack from device
   * @data:	device state
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
286
   */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
  static int sht15_wait_for_response(struct sht15_data *data)
  {
  	gpio_direction_input(data->pdata->gpio_data);
  	gpio_set_value(data->pdata->gpio_sck, 1);
  	ndelay(SHT15_TSCKH);
  	if (gpio_get_value(data->pdata->gpio_data)) {
  		gpio_set_value(data->pdata->gpio_sck, 0);
  		dev_err(data->dev, "Command not acknowledged
  ");
  		sht15_connection_reset(data);
  		return -EIO;
  	}
  	gpio_set_value(data->pdata->gpio_sck, 0);
  	ndelay(SHT15_TSCKL);
  	return 0;
  }
  
  /**
   * sht15_send_cmd() - Sends a command to the device.
   * @data:	device state
   * @cmd:	command byte to be sent
   *
   * On entry, sck is output low, data is output pull high
   * and the interrupt disabled.
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
311
   */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
312
313
314
  static int sht15_send_cmd(struct sht15_data *data, u8 cmd)
  {
  	int ret = 0;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
315

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
316
317
318
319
320
  	sht15_transmission_start(data);
  	sht15_send_byte(data, cmd);
  	ret = sht15_wait_for_response(data);
  	return ret;
  }
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
321

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
322
  /**
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
323
324
325
326
327
328
329
330
331
332
333
334
335
   * sht15_soft_reset() - send a soft reset command
   * @data:	sht15 specific data.
   *
   * As described in section 3.2 of the datasheet.
   */
  static int sht15_soft_reset(struct sht15_data *data)
  {
  	int ret;
  
  	ret = sht15_send_cmd(data, SHT15_SOFT_RESET);
  	if (ret)
  		return ret;
  	msleep(SHT15_TSRST);
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
336
337
338
339
340
341
342
  	/* device resets default hardware status register value */
  	data->val_status = 0;
  
  	return ret;
  }
  
  /**
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
   * sht15_ack() - send a ack
   * @data:	sht15 specific data.
   *
   * Each byte of data is acknowledged by pulling the data line
   * low for one clock pulse.
   */
  static void sht15_ack(struct sht15_data *data)
  {
  	gpio_direction_output(data->pdata->gpio_data, 0);
  	ndelay(SHT15_TSU);
  	gpio_set_value(data->pdata->gpio_sck, 1);
  	ndelay(SHT15_TSU);
  	gpio_set_value(data->pdata->gpio_sck, 0);
  	ndelay(SHT15_TSU);
  	gpio_set_value(data->pdata->gpio_data, 1);
  
  	gpio_direction_input(data->pdata->gpio_data);
  }
  
  /**
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
   * sht15_end_transmission() - notify device of end of transmission
   * @data:	device state.
   *
   * This is basically a NAK (single clock pulse, data high).
   */
  static void sht15_end_transmission(struct sht15_data *data)
  {
  	gpio_direction_output(data->pdata->gpio_data, 1);
  	ndelay(SHT15_TSU);
  	gpio_set_value(data->pdata->gpio_sck, 1);
  	ndelay(SHT15_TSCKH);
  	gpio_set_value(data->pdata->gpio_sck, 0);
  	ndelay(SHT15_TSCKL);
  }
  
  /**
   * sht15_read_byte() - Read a byte back from the device
   * @data:	device state.
   */
  static u8 sht15_read_byte(struct sht15_data *data)
  {
  	int i;
  	u8 byte = 0;
  
  	for (i = 0; i < 8; ++i) {
  		byte <<= 1;
  		gpio_set_value(data->pdata->gpio_sck, 1);
  		ndelay(SHT15_TSCKH);
  		byte |= !!gpio_get_value(data->pdata->gpio_data);
  		gpio_set_value(data->pdata->gpio_sck, 0);
  		ndelay(SHT15_TSCKL);
  	}
  	return byte;
  }
  
  /**
   * sht15_send_status() - write the status register byte
   * @data:	sht15 specific data.
   * @status:	the byte to set the status register with.
   *
   * As described in figure 14 and table 5 of the datasheet.
   */
  static int sht15_send_status(struct sht15_data *data, u8 status)
  {
  	int ret;
  
  	ret = sht15_send_cmd(data, SHT15_WRITE_STATUS);
  	if (ret)
  		return ret;
  	gpio_direction_output(data->pdata->gpio_data, 1);
  	ndelay(SHT15_TSU);
  	sht15_send_byte(data, status);
  	ret = sht15_wait_for_response(data);
  	if (ret)
  		return ret;
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
418

cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
419
  	data->val_status = status;
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
420
421
422
423
  	return 0;
  }
  
  /**
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
424
425
426
427
428
429
430
431
432
   * sht15_update_status() - get updated status register from device if too old
   * @data:	device instance specific data.
   *
   * As described in figure 15 and table 5 of the datasheet.
   */
  static int sht15_update_status(struct sht15_data *data)
  {
  	int ret = 0;
  	u8 status;
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
433
434
435
  	u8 previous_config;
  	u8 dev_checksum = 0;
  	u8 checksum_vals[2];
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
436
437
438
439
440
441
442
443
444
  	int timeout = HZ;
  
  	mutex_lock(&data->read_lock);
  	if (time_after(jiffies, data->last_status + timeout)
  			|| !data->status_valid) {
  		ret = sht15_send_cmd(data, SHT15_READ_STATUS);
  		if (ret)
  			goto error_ret;
  		status = sht15_read_byte(data);
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
445
446
447
448
449
450
451
452
  		if (data->checksumming) {
  			sht15_ack(data);
  			dev_checksum = sht15_reverse(sht15_read_byte(data));
  			checksum_vals[0] = SHT15_READ_STATUS;
  			checksum_vals[1] = status;
  			data->checksum_ok = (sht15_crc8(data, checksum_vals, 2)
  					== dev_checksum);
  		}
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
453
  		sht15_end_transmission(data);
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
  		/*
  		 * Perform checksum validation on the received data.
  		 * Specification mentions that in case a checksum verification
  		 * fails, a soft reset command must be sent to the device.
  		 */
  		if (data->checksumming && !data->checksum_ok) {
  			previous_config = data->val_status & 0x07;
  			ret = sht15_soft_reset(data);
  			if (ret)
  				goto error_ret;
  			if (previous_config) {
  				ret = sht15_send_status(data, previous_config);
  				if (ret) {
  					dev_err(data->dev,
  						"CRC validation failed, unable "
  						"to restore device settings
  ");
  					goto error_ret;
  				}
  			}
  			ret = -EAGAIN;
  			goto error_ret;
  		}
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
477
478
479
480
481
482
483
484
485
486
487
  		data->val_status = status;
  		data->status_valid = true;
  		data->last_status = jiffies;
  	}
  error_ret:
  	mutex_unlock(&data->read_lock);
  
  	return ret;
  }
  
  /**
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
488
   * sht15_measurement() - get a new value from device
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
489
490
491
492
   * @data:		device instance specific data
   * @command:		command sent to request value
   * @timeout_msecs:	timeout after which comms are assumed
   *			to have failed are reset.
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
493
494
495
496
   */
  static int sht15_measurement(struct sht15_data *data,
  			     int command,
  			     int timeout_msecs)
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
497
498
  {
  	int ret;
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
499
  	u8 previous_config;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
500

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
501
502
503
504
505
506
507
508
509
510
  	ret = sht15_send_cmd(data, command);
  	if (ret)
  		return ret;
  
  	gpio_direction_input(data->pdata->gpio_data);
  	atomic_set(&data->interrupt_handled, 0);
  
  	enable_irq(gpio_to_irq(data->pdata->gpio_data));
  	if (gpio_get_value(data->pdata->gpio_data) == 0) {
  		disable_irq_nosync(gpio_to_irq(data->pdata->gpio_data));
25985edce   Lucas De Marchi   Fix common misspe...
511
  		/* Only relevant if the interrupt hasn't occurred. */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
512
513
514
515
  		if (!atomic_read(&data->interrupt_handled))
  			schedule_work(&data->read_work);
  	}
  	ret = wait_event_timeout(data->wait_queue,
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
516
  				 (data->state == SHT15_READING_NOTHING),
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
517
518
  				 msecs_to_jiffies(timeout_msecs));
  	if (ret == 0) {/* timeout occurred */
24205e085   Joe Perches   hwmon: (sht15) Re...
519
  		disable_irq_nosync(gpio_to_irq(data->pdata->gpio_data));
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
520
521
522
  		sht15_connection_reset(data);
  		return -ETIME;
  	}
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
  
  	/*
  	 *  Perform checksum validation on the received data.
  	 *  Specification mentions that in case a checksum verification fails,
  	 *  a soft reset command must be sent to the device.
  	 */
  	if (data->checksumming && !data->checksum_ok) {
  		previous_config = data->val_status & 0x07;
  		ret = sht15_soft_reset(data);
  		if (ret)
  			return ret;
  		if (previous_config) {
  			ret = sht15_send_status(data, previous_config);
  			if (ret) {
  				dev_err(data->dev,
  					"CRC validation failed, unable "
  					"to restore device settings
  ");
  				return ret;
  			}
  		}
  		return -EAGAIN;
  	}
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
546
547
548
549
  	return 0;
  }
  
  /**
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
550
   * sht15_update_measurements() - get updated measures from device if too old
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
551
   * @data:	device state
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
552
553
   */
  static int sht15_update_measurements(struct sht15_data *data)
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
554
555
556
557
558
  {
  	int ret = 0;
  	int timeout = HZ;
  
  	mutex_lock(&data->read_lock);
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
559
560
561
562
  	if (time_after(jiffies, data->last_measurement + timeout)
  	    || !data->measurements_valid) {
  		data->state = SHT15_READING_HUMID;
  		ret = sht15_measurement(data, SHT15_MEASURE_RH, 160);
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
563
564
  		if (ret)
  			goto error_ret;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
565
566
  		data->state = SHT15_READING_TEMP;
  		ret = sht15_measurement(data, SHT15_MEASURE_TEMP, 400);
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
567
568
  		if (ret)
  			goto error_ret;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
569
570
  		data->measurements_valid = true;
  		data->last_measurement = jiffies;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
571
572
573
574
575
576
577
578
579
580
581
582
  	}
  error_ret:
  	mutex_unlock(&data->read_lock);
  
  	return ret;
  }
  
  /**
   * sht15_calc_temp() - convert the raw reading to a temperature
   * @data:	device state
   *
   * As per section 4.3 of the data sheet.
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
583
   */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
584
585
  static inline int sht15_calc_temp(struct sht15_data *data)
  {
328a2c22a   Jerome Oufella   hwmon: (sht15) Fi...
586
  	int d1 = temppoints[0].d1;
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
587
  	int d2 = (data->val_status & SHT15_STATUS_LOW_RESOLUTION) ? 40 : 10;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
588
  	int i;
328a2c22a   Jerome Oufella   hwmon: (sht15) Fi...
589
  	for (i = ARRAY_SIZE(temppoints) - 1; i > 0; i--)
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
590
591
  		/* Find pointer to interpolate */
  		if (data->supply_uV > temppoints[i - 1].vdd) {
328a2c22a   Jerome Oufella   hwmon: (sht15) Fi...
592
  			d1 = (data->supply_uV - temppoints[i - 1].vdd)
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
593
594
595
596
597
  				* (temppoints[i].d1 - temppoints[i - 1].d1)
  				/ (temppoints[i].vdd - temppoints[i - 1].vdd)
  				+ temppoints[i - 1].d1;
  			break;
  		}
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
598
  	return data->val_temp * d2 + d1;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
599
600
601
602
603
604
605
606
  }
  
  /**
   * sht15_calc_humid() - using last temperature convert raw to humid
   * @data:	device state
   *
   * This is the temperature compensated version as per section 4.2 of
   * the data sheet.
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
607
608
609
610
   *
   * The sensor is assumed to be V3, which is compatible with V4.
   * Humidity conversion coefficients are shown in table 7 of the datasheet.
   */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
611
612
  static inline int sht15_calc_humid(struct sht15_data *data)
  {
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
613
  	int rh_linear; /* milli percent */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
614
  	int temp = sht15_calc_temp(data);
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
615
616
  	int c2, c3;
  	int t2;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
617
  	const int c1 = -4;
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
618
619
620
621
622
623
624
625
626
627
  
  	if (data->val_status & SHT15_STATUS_LOW_RESOLUTION) {
  		c2 = 648000; /* x 10 ^ -6 */
  		c3 = -7200;  /* x 10 ^ -7 */
  		t2 = 1280;
  	} else {
  		c2 = 40500;  /* x 10 ^ -6 */
  		c3 = -28;    /* x 10 ^ -7 */
  		t2 = 80;
  	}
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
628

99a0378de   Vivien Didelot   hwmon: (sht15) ge...
629
630
  	rh_linear = c1 * 1000
  		+ c2 * data->val_humid / 1000
ccd32e735   Vivien Didelot   hwmon: (sht15) Fi...
631
  		+ (data->val_humid * data->val_humid * c3) / 10000;
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
632
  	return (temp - 25000) * (10000 + t2 * data->val_humid)
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
633
  		/ 1000000 + rh_linear;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
634
  }
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
635
  /**
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
   * sht15_show_status() - show status information in sysfs
   * @dev:	device.
   * @attr:	device attribute.
   * @buf:	sysfs buffer where information is written to.
   *
   * Will be called on read access to temp1_fault, humidity1_fault
   * and heater_enable sysfs attributes.
   * Returns number of bytes written into buffer, negative errno on error.
   */
  static ssize_t sht15_show_status(struct device *dev,
  				 struct device_attribute *attr,
  				 char *buf)
  {
  	int ret;
  	struct sht15_data *data = dev_get_drvdata(dev);
  	u8 bit = to_sensor_dev_attr(attr)->index;
  
  	ret = sht15_update_status(data);
  
  	return ret ? ret : sprintf(buf, "%d
  ", !!(data->val_status & bit));
  }
  
  /**
   * sht15_store_heater() - change heater state via sysfs
   * @dev:	device.
   * @attr:	device attribute.
   * @buf:	sysfs buffer to read the new heater state from.
   * @count:	length of the data.
   *
e9b6e9f3d   Vivien Didelot   hwmon: (sht15) Co...
666
   * Will be called on write access to heater_enable sysfs attribute.
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
667
668
669
670
671
672
673
674
675
676
   * Returns number of bytes actually decoded, negative errno on error.
   */
  static ssize_t sht15_store_heater(struct device *dev,
  				  struct device_attribute *attr,
  				  const char *buf, size_t count)
  {
  	int ret;
  	struct sht15_data *data = dev_get_drvdata(dev);
  	long value;
  	u8 status;
179c4fdb5   Frans Meulenbroeks   hwmon: replaced s...
677
  	if (kstrtol(buf, 10, &value))
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
  		return -EINVAL;
  
  	mutex_lock(&data->read_lock);
  	status = data->val_status & 0x07;
  	if (!!value)
  		status |= SHT15_STATUS_HEATER;
  	else
  		status &= ~SHT15_STATUS_HEATER;
  
  	ret = sht15_send_status(data, status);
  	mutex_unlock(&data->read_lock);
  
  	return ret ? ret : count;
  }
  
  /**
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
694
695
696
697
698
699
700
701
   * sht15_show_temp() - show temperature measurement value in sysfs
   * @dev:	device.
   * @attr:	device attribute.
   * @buf:	sysfs buffer where measurement values are written to.
   *
   * Will be called on read access to temp1_input sysfs attribute.
   * Returns number of bytes written into buffer, negative errno on error.
   */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
702
703
704
705
706
707
708
709
  static ssize_t sht15_show_temp(struct device *dev,
  			       struct device_attribute *attr,
  			       char *buf)
  {
  	int ret;
  	struct sht15_data *data = dev_get_drvdata(dev);
  
  	/* Technically no need to read humidity as well */
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
710
  	ret = sht15_update_measurements(data);
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
711
712
713
714
715
  
  	return ret ? ret : sprintf(buf, "%d
  ",
  				   sht15_calc_temp(data));
  }
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
716
717
718
719
720
721
722
723
724
  /**
   * sht15_show_humidity() - show humidity measurement value in sysfs
   * @dev:	device.
   * @attr:	device attribute.
   * @buf:	sysfs buffer where measurement values are written to.
   *
   * Will be called on read access to humidity1_input sysfs attribute.
   * Returns number of bytes written into buffer, negative errno on error.
   */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
725
726
727
728
729
730
  static ssize_t sht15_show_humidity(struct device *dev,
  				   struct device_attribute *attr,
  				   char *buf)
  {
  	int ret;
  	struct sht15_data *data = dev_get_drvdata(dev);
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
731
  	ret = sht15_update_measurements(data);
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
732
733
734
  
  	return ret ? ret : sprintf(buf, "%d
  ", sht15_calc_humid(data));
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
735
  }
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
736
737
738
739
740
741
742
743
  static ssize_t show_name(struct device *dev,
  			 struct device_attribute *attr,
  			 char *buf)
  {
  	struct platform_device *pdev = to_platform_device(dev);
  	return sprintf(buf, "%s
  ", pdev->name);
  }
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
744
745
746
747
  static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO,
  			  sht15_show_temp, NULL, 0);
  static SENSOR_DEVICE_ATTR(humidity1_input, S_IRUGO,
  			  sht15_show_humidity, NULL, 0);
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
748
749
750
751
752
753
  static SENSOR_DEVICE_ATTR(temp1_fault, S_IRUGO, sht15_show_status, NULL,
  			  SHT15_STATUS_LOW_BATTERY);
  static SENSOR_DEVICE_ATTR(humidity1_fault, S_IRUGO, sht15_show_status, NULL,
  			  SHT15_STATUS_LOW_BATTERY);
  static SENSOR_DEVICE_ATTR(heater_enable, S_IRUGO | S_IWUSR, sht15_show_status,
  			  sht15_store_heater, SHT15_STATUS_HEATER);
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
754
755
756
757
  static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
  static struct attribute *sht15_attrs[] = {
  	&sensor_dev_attr_temp1_input.dev_attr.attr,
  	&sensor_dev_attr_humidity1_input.dev_attr.attr,
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
758
759
760
  	&sensor_dev_attr_temp1_fault.dev_attr.attr,
  	&sensor_dev_attr_humidity1_fault.dev_attr.attr,
  	&sensor_dev_attr_heater_enable.dev_attr.attr,
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
761
762
763
764
765
766
767
768
769
770
771
  	&dev_attr_name.attr,
  	NULL,
  };
  
  static const struct attribute_group sht15_attr_group = {
  	.attrs = sht15_attrs,
  };
  
  static irqreturn_t sht15_interrupt_fired(int irq, void *d)
  {
  	struct sht15_data *data = d;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
772

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
773
774
775
776
  	/* First disable the interrupt */
  	disable_irq_nosync(irq);
  	atomic_inc(&data->interrupt_handled);
  	/* Then schedule a reading work struct */
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
777
  	if (data->state != SHT15_READING_NOTHING)
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
778
779
780
  		schedule_work(&data->read_work);
  	return IRQ_HANDLED;
  }
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
781
782
  static void sht15_bh_read_data(struct work_struct *work_s)
  {
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
783
  	uint16_t val = 0;
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
784
785
  	u8 dev_checksum = 0;
  	u8 checksum_vals[3];
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
786
787
788
  	struct sht15_data *data
  		= container_of(work_s, struct sht15_data,
  			       read_work);
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
789

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
790
791
  	/* Firstly, verify the line is low */
  	if (gpio_get_value(data->pdata->gpio_data)) {
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
792
793
794
795
  		/*
  		 * If not, then start the interrupt again - care here as could
  		 * have gone low in meantime so verify it hasn't!
  		 */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
796
797
  		atomic_set(&data->interrupt_handled, 0);
  		enable_irq(gpio_to_irq(data->pdata->gpio_data));
25985edce   Lucas De Marchi   Fix common misspe...
798
  		/* If still not occurred or another handler has been scheduled */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
799
800
801
802
  		if (gpio_get_value(data->pdata->gpio_data)
  		    || atomic_read(&data->interrupt_handled))
  			return;
  	}
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
803

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
804
  	/* Read the data back from the device */
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
805
806
807
808
  	val = sht15_read_byte(data);
  	val <<= 8;
  	sht15_ack(data);
  	val |= sht15_read_byte(data);
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
809

82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
810
811
812
813
814
815
816
817
818
819
820
821
822
823
  	if (data->checksumming) {
  		/*
  		 * Ask the device for a checksum and read it back.
  		 * Note: the device sends the checksum byte reversed.
  		 */
  		sht15_ack(data);
  		dev_checksum = sht15_reverse(sht15_read_byte(data));
  		checksum_vals[0] = (data->state == SHT15_READING_TEMP) ?
  			SHT15_MEASURE_TEMP : SHT15_MEASURE_RH;
  		checksum_vals[1] = (u8) (val >> 8);
  		checksum_vals[2] = (u8) val;
  		data->checksum_ok
  			= (sht15_crc8(data, checksum_vals, 3) == dev_checksum);
  	}
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
824
825
  	/* Tell the device we are done */
  	sht15_end_transmission(data);
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
826
  	switch (data->state) {
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
827
828
829
830
831
832
  	case SHT15_READING_TEMP:
  		data->val_temp = val;
  		break;
  	case SHT15_READING_HUMID:
  		data->val_humid = val;
  		break;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
833
834
  	default:
  		break;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
835
  	}
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
836
  	data->state = SHT15_READING_NOTHING;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
837
838
839
840
841
842
843
844
845
846
847
848
849
850
851
852
853
854
855
  	wake_up(&data->wait_queue);
  }
  
  static void sht15_update_voltage(struct work_struct *work_s)
  {
  	struct sht15_data *data
  		= container_of(work_s, struct sht15_data,
  			       update_supply_work);
  	data->supply_uV = regulator_get_voltage(data->reg);
  }
  
  /**
   * sht15_invalidate_voltage() - mark supply voltage invalid when notified by reg
   * @nb:		associated notification structure
   * @event:	voltage regulator state change event code
   * @ignored:	function parameter - ignored here
   *
   * Note that as the notification code holds the regulator lock, we have
   * to schedule an update of the supply voltage rather than getting it directly.
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
856
   */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
857
  static int sht15_invalidate_voltage(struct notifier_block *nb,
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
858
859
  				    unsigned long event,
  				    void *ignored)
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
860
861
862
863
864
865
866
867
868
869
870
871
872
873
  {
  	struct sht15_data *data = container_of(nb, struct sht15_data, nb);
  
  	if (event == REGULATOR_EVENT_VOLTAGE_CHANGE)
  		data->supply_uV_valid = false;
  	schedule_work(&data->update_supply_work);
  
  	return NOTIFY_OK;
  }
  
  static int __devinit sht15_probe(struct platform_device *pdev)
  {
  	int ret = 0;
  	struct sht15_data *data = kzalloc(sizeof(*data), GFP_KERNEL);
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
874
  	u8 status = 0;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
875
876
877
  
  	if (!data) {
  		ret = -ENOMEM;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
878
879
  		dev_err(&pdev->dev, "kzalloc failed
  ");
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
880
881
882
883
884
885
886
887
888
889
890
  		goto error_ret;
  	}
  
  	INIT_WORK(&data->read_work, sht15_bh_read_data);
  	INIT_WORK(&data->update_supply_work, sht15_update_voltage);
  	platform_set_drvdata(pdev, data);
  	mutex_init(&data->read_lock);
  	data->dev = &pdev->dev;
  	init_waitqueue_head(&data->wait_queue);
  
  	if (pdev->dev.platform_data == NULL) {
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
891
892
  		dev_err(&pdev->dev, "no platform data supplied
  ");
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
893
894
895
  		goto err_free_data;
  	}
  	data->pdata = pdev->dev.platform_data;
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
896
  	data->supply_uV = data->pdata->supply_mv * 1000;
82c7465b4   Jerome Oufella   hwmon: (sht15) ad...
897
898
  	if (data->pdata->checksum)
  		data->checksumming = true;
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
899
900
901
902
  	if (data->pdata->no_otp_reload)
  		status |= SHT15_STATUS_NO_OTP_RELOAD;
  	if (data->pdata->low_resolution)
  		status |= SHT15_STATUS_LOW_RESOLUTION;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
903

99a0378de   Vivien Didelot   hwmon: (sht15) ge...
904
905
906
907
  	/*
  	 * If a regulator is available,
  	 * query what the supply voltage actually is!
  	 */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
908
909
  	data->reg = regulator_get(data->dev, "vcc");
  	if (!IS_ERR(data->reg)) {
c7a78d2c2   Jean Delvare   hwmon: (sht15) Pr...
910
911
912
913
914
  		int voltage;
  
  		voltage = regulator_get_voltage(data->reg);
  		if (voltage)
  			data->supply_uV = voltage;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
915
  		regulator_enable(data->reg);
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
916
917
918
919
  		/*
  		 * Setup a notifier block to update this if another device
  		 * causes the voltage to change
  		 */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
920
921
  		data->nb.notifier_call = &sht15_invalidate_voltage;
  		ret = regulator_register_notifier(data->reg, &data->nb);
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
922
923
924
925
926
927
928
929
  		if (ret) {
  			dev_err(&pdev->dev,
  				"regulator notifier request failed
  ");
  			regulator_disable(data->reg);
  			regulator_put(data->reg);
  			goto err_free_data;
  		}
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
930
  	}
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
931
932
  
  	/* Try requesting the GPIOs */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
933
934
  	ret = gpio_request(data->pdata->gpio_sck, "SHT15 sck");
  	if (ret) {
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
935
936
  		dev_err(&pdev->dev, "gpio request failed
  ");
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
937
  		goto err_release_reg;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
938
939
  	}
  	gpio_direction_output(data->pdata->gpio_sck, 0);
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
940

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
941
942
  	ret = gpio_request(data->pdata->gpio_data, "SHT15 data");
  	if (ret) {
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
943
944
  		dev_err(&pdev->dev, "gpio request failed
  ");
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
945
946
  		goto err_release_gpio_sck;
  	}
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
947
948
949
950
951
952
953
  
  	ret = request_irq(gpio_to_irq(data->pdata->gpio_data),
  			  sht15_interrupt_fired,
  			  IRQF_TRIGGER_FALLING,
  			  "sht15 data",
  			  data);
  	if (ret) {
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
954
955
  		dev_err(&pdev->dev, "failed to get irq for data line
  ");
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
956
957
958
959
  		goto err_release_gpio_data;
  	}
  	disable_irq_nosync(gpio_to_irq(data->pdata->gpio_data));
  	sht15_connection_reset(data);
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
960
961
962
  	ret = sht15_soft_reset(data);
  	if (ret)
  		goto err_release_irq;
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
963
964
965
966
967
968
  	/* write status with platform data options */
  	if (status) {
  		ret = sht15_send_status(data, status);
  		if (ret)
  			goto err_release_irq;
  	}
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
969
970
971
972
973
974
  	ret = sysfs_create_group(&pdev->dev.kobj, &sht15_attr_group);
  	if (ret) {
  		dev_err(&pdev->dev, "sysfs create failed
  ");
  		goto err_release_irq;
  	}
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
975
976
977
978
  
  	data->hwmon_dev = hwmon_device_register(data->dev);
  	if (IS_ERR(data->hwmon_dev)) {
  		ret = PTR_ERR(data->hwmon_dev);
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
979
  		goto err_release_sysfs_group;
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
980
  	}
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
981

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
982
  	return 0;
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
983
984
  err_release_sysfs_group:
  	sysfs_remove_group(&pdev->dev.kobj, &sht15_attr_group);
560a64a2b   Roel Kluin   hwmon: fix freein...
985
986
  err_release_irq:
  	free_irq(gpio_to_irq(data->pdata->gpio_data), data);
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
987
988
989
990
  err_release_gpio_data:
  	gpio_free(data->pdata->gpio_data);
  err_release_gpio_sck:
  	gpio_free(data->pdata->gpio_sck);
181148ae6   Vivien Didelot   hwmon: (sht15) cl...
991
992
993
994
995
996
  err_release_reg:
  	if (!IS_ERR(data->reg)) {
  		regulator_unregister_notifier(data->reg, &data->nb);
  		regulator_disable(data->reg);
  		regulator_put(data->reg);
  	}
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
997
998
999
  err_free_data:
  	kfree(data);
  error_ret:
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1000
1001
1002
1003
1004
1005
  	return ret;
  }
  
  static int __devexit sht15_remove(struct platform_device *pdev)
  {
  	struct sht15_data *data = platform_get_drvdata(pdev);
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
1006
1007
1008
1009
  	/*
  	 * Make sure any reads from the device are done and
  	 * prevent new ones beginning
  	 */
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1010
  	mutex_lock(&data->read_lock);
cc15c7ebb   Vivien Didelot   hwmon: (sht15) ad...
1011
1012
1013
1014
  	if (sht15_soft_reset(data)) {
  		mutex_unlock(&data->read_lock);
  		return -EFAULT;
  	}
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1015
1016
1017
1018
1019
1020
1021
1022
1023
1024
1025
1026
1027
  	hwmon_device_unregister(data->hwmon_dev);
  	sysfs_remove_group(&pdev->dev.kobj, &sht15_attr_group);
  	if (!IS_ERR(data->reg)) {
  		regulator_unregister_notifier(data->reg, &data->nb);
  		regulator_disable(data->reg);
  		regulator_put(data->reg);
  	}
  
  	free_irq(gpio_to_irq(data->pdata->gpio_data), data);
  	gpio_free(data->pdata->gpio_data);
  	gpio_free(data->pdata->gpio_sck);
  	mutex_unlock(&data->read_lock);
  	kfree(data);
99a0378de   Vivien Didelot   hwmon: (sht15) ge...
1028

251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1029
1030
  	return 0;
  }
cb0f1a1e7   Rakib Mullick   hwmon: (sht15) Fi...
1031
1032
1033
1034
1035
1036
  /*
   * sht_drivers simultaneously refers to __devinit and __devexit function
   * which causes spurious section mismatch warning. So use __refdata to
   * get rid from this.
   */
  static struct platform_driver __refdata sht_drivers[] = {
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1037
1038
1039
1040
1041
1042
  	{
  		.driver = {
  			.name = "sht10",
  			.owner = THIS_MODULE,
  		},
  		.probe = sht15_probe,
cd659fd0d   Jean Delvare   hwmon: Fix more _...
1043
  		.remove = __devexit_p(sht15_remove),
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1044
1045
1046
1047
1048
1049
  	}, {
  		.driver = {
  			.name = "sht11",
  			.owner = THIS_MODULE,
  		},
  		.probe = sht15_probe,
cd659fd0d   Jean Delvare   hwmon: Fix more _...
1050
  		.remove = __devexit_p(sht15_remove),
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1051
1052
1053
1054
1055
1056
  	}, {
  		.driver = {
  			.name = "sht15",
  			.owner = THIS_MODULE,
  		},
  		.probe = sht15_probe,
cd659fd0d   Jean Delvare   hwmon: Fix more _...
1057
  		.remove = __devexit_p(sht15_remove),
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1058
1059
1060
1061
1062
1063
  	}, {
  		.driver = {
  			.name = "sht71",
  			.owner = THIS_MODULE,
  		},
  		.probe = sht15_probe,
cd659fd0d   Jean Delvare   hwmon: Fix more _...
1064
  		.remove = __devexit_p(sht15_remove),
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1065
1066
1067
1068
1069
1070
  	}, {
  		.driver = {
  			.name = "sht75",
  			.owner = THIS_MODULE,
  		},
  		.probe = sht15_probe,
cd659fd0d   Jean Delvare   hwmon: Fix more _...
1071
  		.remove = __devexit_p(sht15_remove),
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1072
1073
  	},
  };
251eb40f5   Jonathan Cameron   hwmon: sht15 humi...
1074
1075
1076
1077
1078
1079
1080
1081
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
  static int __init sht15_init(void)
  {
  	int ret;
  	int i;
  
  	for (i = 0; i < ARRAY_SIZE(sht_drivers); i++) {
  		ret = platform_driver_register(&sht_drivers[i]);
  		if (ret)
  			goto error_unreg;
  	}
  
  	return 0;
  
  error_unreg:
  	while (--i >= 0)
  		platform_driver_unregister(&sht_drivers[i]);
  
  	return ret;
  }
  module_init(sht15_init);
  
  static void __exit sht15_exit(void)
  {
  	int i;
  	for (i = ARRAY_SIZE(sht_drivers) - 1; i >= 0; i--)
  		platform_driver_unregister(&sht_drivers[i]);
  }
  module_exit(sht15_exit);
  
  MODULE_LICENSE("GPL");