xref: /openbmc/linux/drivers/hwmon/sht15.c (revision 82ced6fd)
1 /*
2  * sht15.c - support for the SHT15 Temperature and Humidity Sensor
3  *
4  * Copyright (c) 2009 Jonathan Cameron
5  *
6  * Copyright (c) 2007 Wouter Horre
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  *
12  * Currently ignoring checksum on readings.
13  * Default resolution only (14bit temp, 12bit humidity)
14  * Ignoring battery status.
15  * Heater not enabled.
16  * Timings are all conservative.
17  *
18  * Data sheet available (1/2009) at
19  * http://www.sensirion.ch/en/pdf/product_information/Datasheet-humidity-sensor-SHT1x.pdf
20  *
21  * Regulator supply name = vcc
22  */
23 
24 #include <linux/interrupt.h>
25 #include <linux/irq.h>
26 #include <linux/gpio.h>
27 #include <linux/module.h>
28 #include <linux/init.h>
29 #include <linux/hwmon.h>
30 #include <linux/hwmon-sysfs.h>
31 #include <linux/mutex.h>
32 #include <linux/platform_device.h>
33 #include <linux/delay.h>
34 #include <linux/jiffies.h>
35 #include <linux/err.h>
36 #include <linux/sht15.h>
37 #include <linux/regulator/consumer.h>
38 #include <asm/atomic.h>
39 
40 #define SHT15_MEASURE_TEMP	3
41 #define SHT15_MEASURE_RH	5
42 
43 #define SHT15_READING_NOTHING	0
44 #define SHT15_READING_TEMP	1
45 #define SHT15_READING_HUMID	2
46 
47 /* Min timings in nsecs */
48 #define SHT15_TSCKL		100	/* clock low */
49 #define SHT15_TSCKH		100	/* clock high */
50 #define SHT15_TSU		150	/* data setup time */
51 
52 /**
53  * struct sht15_temppair - elements of voltage dependant temp calc
54  * @vdd:	supply voltage in microvolts
55  * @d1:		see data sheet
56  */
57 struct sht15_temppair {
58 	int vdd; /* microvolts */
59 	int d1;
60 };
61 
62 /* Table 9 from data sheet - relates temperature calculation
63  * to supply voltage.
64  */
65 static const struct sht15_temppair temppoints[] = {
66 	{ 2500000, -39400 },
67 	{ 3000000, -39600 },
68 	{ 3500000, -39700 },
69 	{ 4000000, -39800 },
70 	{ 5000000, -40100 },
71 };
72 
73 /**
74  * struct sht15_data - device instance specific data
75  * @pdata:	platform data (gpio's etc)
76  * @read_work:	bh of interrupt handler
77  * @wait_queue:	wait queue for getting values from device
78  * @val_temp:	last temperature value read from device
79  * @val_humid: 	last humidity value read from device
80  * @flag:	status flag used to identify what the last request was
81  * @valid:	are the current stored values valid (start condition)
82  * @last_updat:	time of last update
83  * @read_lock:	mutex to ensure only one read in progress
84  *		at a time.
85  * @dev:	associate device structure
86  * @hwmon_dev:	device associated with hwmon subsystem
87  * @reg:	associated regulator (if specified)
88  * @nb:		notifier block to handle notifications of voltage changes
89  * @supply_uV:	local copy of supply voltage used to allow
90  *		use of regulator consumer if available
91  * @supply_uV_valid:   indicates that an updated value has not yet
92  *		been obtained from the regulator and so any calculations
93  *		based upon it will be invalid.
94  * @update_supply_work:	work struct that is used to update the supply_uV
95  * @interrupt_handled:	flag used to indicate a hander has been scheduled
96  */
97 struct sht15_data {
98 	struct sht15_platform_data	*pdata;
99 	struct work_struct		read_work;
100 	wait_queue_head_t		wait_queue;
101 	uint16_t			val_temp;
102 	uint16_t			val_humid;
103 	u8				flag;
104 	u8				valid;
105 	unsigned long			last_updat;
106 	struct mutex			read_lock;
107 	struct device			*dev;
108 	struct device			*hwmon_dev;
109 	struct regulator		*reg;
110 	struct notifier_block		nb;
111 	int				supply_uV;
112 	int				supply_uV_valid;
113 	struct work_struct		update_supply_work;
114 	atomic_t			interrupt_handled;
115 };
116 
117 /**
118  * sht15_connection_reset() - reset the comms interface
119  * @data:	sht15 specific data
120  *
121  * This implements section 3.4 of the data sheet
122  */
123 static void sht15_connection_reset(struct sht15_data *data)
124 {
125 	int i;
126 	gpio_direction_output(data->pdata->gpio_data, 1);
127 	ndelay(SHT15_TSCKL);
128 	gpio_set_value(data->pdata->gpio_sck, 0);
129 	ndelay(SHT15_TSCKL);
130 	for (i = 0; i < 9; ++i) {
131 		gpio_set_value(data->pdata->gpio_sck, 1);
132 		ndelay(SHT15_TSCKH);
133 		gpio_set_value(data->pdata->gpio_sck, 0);
134 		ndelay(SHT15_TSCKL);
135 	}
136 }
137 /**
138  * sht15_send_bit() - send an individual bit to the device
139  * @data:	device state data
140  * @val:	value of bit to be sent
141  **/
142 static inline void sht15_send_bit(struct sht15_data *data, int val)
143 {
144 
145 	gpio_set_value(data->pdata->gpio_data, val);
146 	ndelay(SHT15_TSU);
147 	gpio_set_value(data->pdata->gpio_sck, 1);
148 	ndelay(SHT15_TSCKH);
149 	gpio_set_value(data->pdata->gpio_sck, 0);
150 	ndelay(SHT15_TSCKL); /* clock low time */
151 }
152 
153 /**
154  * sht15_transmission_start() - specific sequence for new transmission
155  *
156  * @data:	device state data
157  * Timings for this are not documented on the data sheet, so very
158  * conservative ones used in implementation. This implements
159  * figure 12 on the data sheet.
160  **/
161 static void sht15_transmission_start(struct sht15_data *data)
162 {
163 	/* ensure data is high and output */
164 	gpio_direction_output(data->pdata->gpio_data, 1);
165 	ndelay(SHT15_TSU);
166 	gpio_set_value(data->pdata->gpio_sck, 0);
167 	ndelay(SHT15_TSCKL);
168 	gpio_set_value(data->pdata->gpio_sck, 1);
169 	ndelay(SHT15_TSCKH);
170 	gpio_set_value(data->pdata->gpio_data, 0);
171 	ndelay(SHT15_TSU);
172 	gpio_set_value(data->pdata->gpio_sck, 0);
173 	ndelay(SHT15_TSCKL);
174 	gpio_set_value(data->pdata->gpio_sck, 1);
175 	ndelay(SHT15_TSCKH);
176 	gpio_set_value(data->pdata->gpio_data, 1);
177 	ndelay(SHT15_TSU);
178 	gpio_set_value(data->pdata->gpio_sck, 0);
179 	ndelay(SHT15_TSCKL);
180 }
181 /**
182  * sht15_send_byte() - send a single byte to the device
183  * @data:	device state
184  * @byte:	value to be sent
185  **/
186 static void sht15_send_byte(struct sht15_data *data, u8 byte)
187 {
188 	int i;
189 	for (i = 0; i < 8; i++) {
190 		sht15_send_bit(data, !!(byte & 0x80));
191 		byte <<= 1;
192 	}
193 }
194 /**
195  * sht15_wait_for_response() - checks for ack from device
196  * @data:	device state
197  **/
198 static int sht15_wait_for_response(struct sht15_data *data)
199 {
200 	gpio_direction_input(data->pdata->gpio_data);
201 	gpio_set_value(data->pdata->gpio_sck, 1);
202 	ndelay(SHT15_TSCKH);
203 	if (gpio_get_value(data->pdata->gpio_data)) {
204 		gpio_set_value(data->pdata->gpio_sck, 0);
205 		dev_err(data->dev, "Command not acknowledged\n");
206 		sht15_connection_reset(data);
207 		return -EIO;
208 	}
209 	gpio_set_value(data->pdata->gpio_sck, 0);
210 	ndelay(SHT15_TSCKL);
211 	return 0;
212 }
213 
214 /**
215  * sht15_send_cmd() - Sends a command to the device.
216  * @data:	device state
217  * @cmd:	command byte to be sent
218  *
219  * On entry, sck is output low, data is output pull high
220  * and the interrupt disabled.
221  **/
222 static int sht15_send_cmd(struct sht15_data *data, u8 cmd)
223 {
224 	int ret = 0;
225 	sht15_transmission_start(data);
226 	sht15_send_byte(data, cmd);
227 	ret = sht15_wait_for_response(data);
228 	return ret;
229 }
230 /**
231  * sht15_update_single_val() - get a new value from device
232  * @data:		device instance specific data
233  * @command:		command sent to request value
234  * @timeout_msecs:	timeout after which comms are assumed
235  *			to have failed are reset.
236  **/
237 static inline int sht15_update_single_val(struct sht15_data *data,
238 					  int command,
239 					  int timeout_msecs)
240 {
241 	int ret;
242 	ret = sht15_send_cmd(data, command);
243 	if (ret)
244 		return ret;
245 
246 	gpio_direction_input(data->pdata->gpio_data);
247 	atomic_set(&data->interrupt_handled, 0);
248 
249 	enable_irq(gpio_to_irq(data->pdata->gpio_data));
250 	if (gpio_get_value(data->pdata->gpio_data) == 0) {
251 		disable_irq_nosync(gpio_to_irq(data->pdata->gpio_data));
252 		/* Only relevant if the interrupt hasn't occured. */
253 		if (!atomic_read(&data->interrupt_handled))
254 			schedule_work(&data->read_work);
255 	}
256 	ret = wait_event_timeout(data->wait_queue,
257 				 (data->flag == SHT15_READING_NOTHING),
258 				 msecs_to_jiffies(timeout_msecs));
259 	if (ret == 0) {/* timeout occurred */
260 		disable_irq_nosync(gpio_to_irq(data->pdata->gpio_data));;
261 		sht15_connection_reset(data);
262 		return -ETIME;
263 	}
264 	return 0;
265 }
266 
267 /**
268  * sht15_update_vals() - get updated readings from device if too old
269  * @data:	device state
270  **/
271 static int sht15_update_vals(struct sht15_data *data)
272 {
273 	int ret = 0;
274 	int timeout = HZ;
275 
276 	mutex_lock(&data->read_lock);
277 	if (time_after(jiffies, data->last_updat + timeout)
278 	    || !data->valid) {
279 		data->flag = SHT15_READING_HUMID;
280 		ret = sht15_update_single_val(data, SHT15_MEASURE_RH, 160);
281 		if (ret)
282 			goto error_ret;
283 		data->flag = SHT15_READING_TEMP;
284 		ret = sht15_update_single_val(data, SHT15_MEASURE_TEMP, 400);
285 		if (ret)
286 			goto error_ret;
287 		data->valid = 1;
288 		data->last_updat = jiffies;
289 	}
290 error_ret:
291 	mutex_unlock(&data->read_lock);
292 
293 	return ret;
294 }
295 
296 /**
297  * sht15_calc_temp() - convert the raw reading to a temperature
298  * @data:	device state
299  *
300  * As per section 4.3 of the data sheet.
301  **/
302 static inline int sht15_calc_temp(struct sht15_data *data)
303 {
304 	int d1 = 0;
305 	int i;
306 
307 	for (i = 1; i < ARRAY_SIZE(temppoints) - 1; i++)
308 		/* Find pointer to interpolate */
309 		if (data->supply_uV > temppoints[i - 1].vdd) {
310 			d1 = (data->supply_uV/1000 - temppoints[i - 1].vdd)
311 				* (temppoints[i].d1 - temppoints[i - 1].d1)
312 				/ (temppoints[i].vdd - temppoints[i - 1].vdd)
313 				+ temppoints[i - 1].d1;
314 			break;
315 		}
316 
317 	return data->val_temp*10 + d1;
318 }
319 
320 /**
321  * sht15_calc_humid() - using last temperature convert raw to humid
322  * @data:	device state
323  *
324  * This is the temperature compensated version as per section 4.2 of
325  * the data sheet.
326  **/
327 static inline int sht15_calc_humid(struct sht15_data *data)
328 {
329 	int RHlinear; /* milli percent */
330 	int temp = sht15_calc_temp(data);
331 
332 	const int c1 = -4;
333 	const int c2 = 40500; /* x 10 ^ -6 */
334 	const int c3 = 2800; /* x10 ^ -9 */
335 
336 	RHlinear = c1*1000
337 		+ c2 * data->val_humid/1000
338 		+ (data->val_humid * data->val_humid * c3)/1000000;
339 	return (temp - 25000) * (10000 + 800 * data->val_humid)
340 		/ 1000000 + RHlinear;
341 }
342 
343 static ssize_t sht15_show_temp(struct device *dev,
344 			       struct device_attribute *attr,
345 			       char *buf)
346 {
347 	int ret;
348 	struct sht15_data *data = dev_get_drvdata(dev);
349 
350 	/* Technically no need to read humidity as well */
351 	ret = sht15_update_vals(data);
352 
353 	return ret ? ret : sprintf(buf, "%d\n",
354 				   sht15_calc_temp(data));
355 }
356 
357 static ssize_t sht15_show_humidity(struct device *dev,
358 				   struct device_attribute *attr,
359 				   char *buf)
360 {
361 	int ret;
362 	struct sht15_data *data = dev_get_drvdata(dev);
363 
364 	ret = sht15_update_vals(data);
365 
366 	return ret ? ret : sprintf(buf, "%d\n", sht15_calc_humid(data));
367 
368 };
369 static ssize_t show_name(struct device *dev,
370 			 struct device_attribute *attr,
371 			 char *buf)
372 {
373 	struct platform_device *pdev = to_platform_device(dev);
374 	return sprintf(buf, "%s\n", pdev->name);
375 }
376 
377 static SENSOR_DEVICE_ATTR(temp1_input,
378 			  S_IRUGO, sht15_show_temp,
379 			  NULL, 0);
380 static SENSOR_DEVICE_ATTR(humidity1_input,
381 			  S_IRUGO, sht15_show_humidity,
382 			  NULL, 0);
383 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
384 static struct attribute *sht15_attrs[] = {
385 	&sensor_dev_attr_temp1_input.dev_attr.attr,
386 	&sensor_dev_attr_humidity1_input.dev_attr.attr,
387 	&dev_attr_name.attr,
388 	NULL,
389 };
390 
391 static const struct attribute_group sht15_attr_group = {
392 	.attrs = sht15_attrs,
393 };
394 
395 static irqreturn_t sht15_interrupt_fired(int irq, void *d)
396 {
397 	struct sht15_data *data = d;
398 	/* First disable the interrupt */
399 	disable_irq_nosync(irq);
400 	atomic_inc(&data->interrupt_handled);
401 	/* Then schedule a reading work struct */
402 	if (data->flag != SHT15_READING_NOTHING)
403 		schedule_work(&data->read_work);
404 	return IRQ_HANDLED;
405 }
406 
407 /* Each byte of data is acknowledged by pulling the data line
408  * low for one clock pulse.
409  */
410 static void sht15_ack(struct sht15_data *data)
411 {
412 	gpio_direction_output(data->pdata->gpio_data, 0);
413 	ndelay(SHT15_TSU);
414 	gpio_set_value(data->pdata->gpio_sck, 1);
415 	ndelay(SHT15_TSU);
416 	gpio_set_value(data->pdata->gpio_sck, 0);
417 	ndelay(SHT15_TSU);
418 	gpio_set_value(data->pdata->gpio_data, 1);
419 
420 	gpio_direction_input(data->pdata->gpio_data);
421 }
422 /**
423  * sht15_end_transmission() - notify device of end of transmission
424  * @data:	device state
425  *
426  * This is basically a NAK. (single clock pulse, data high)
427  **/
428 static void sht15_end_transmission(struct sht15_data *data)
429 {
430 	gpio_direction_output(data->pdata->gpio_data, 1);
431 	ndelay(SHT15_TSU);
432 	gpio_set_value(data->pdata->gpio_sck, 1);
433 	ndelay(SHT15_TSCKH);
434 	gpio_set_value(data->pdata->gpio_sck, 0);
435 	ndelay(SHT15_TSCKL);
436 }
437 
438 static void sht15_bh_read_data(struct work_struct *work_s)
439 {
440 	int i;
441 	uint16_t val = 0;
442 	struct sht15_data *data
443 		= container_of(work_s, struct sht15_data,
444 			       read_work);
445 	/* Firstly, verify the line is low */
446 	if (gpio_get_value(data->pdata->gpio_data)) {
447 		/* If not, then start the interrupt again - care
448 		   here as could have gone low in meantime so verify
449 		   it hasn't!
450 		*/
451 		atomic_set(&data->interrupt_handled, 0);
452 		enable_irq(gpio_to_irq(data->pdata->gpio_data));
453 		/* If still not occured or another handler has been scheduled */
454 		if (gpio_get_value(data->pdata->gpio_data)
455 		    || atomic_read(&data->interrupt_handled))
456 			return;
457 	}
458 	/* Read the data back from the device */
459 	for (i = 0; i < 16; ++i) {
460 		val <<= 1;
461 		gpio_set_value(data->pdata->gpio_sck, 1);
462 		ndelay(SHT15_TSCKH);
463 		val |= !!gpio_get_value(data->pdata->gpio_data);
464 		gpio_set_value(data->pdata->gpio_sck, 0);
465 		ndelay(SHT15_TSCKL);
466 		if (i == 7)
467 			sht15_ack(data);
468 	}
469 	/* Tell the device we are done */
470 	sht15_end_transmission(data);
471 
472 	switch (data->flag) {
473 	case SHT15_READING_TEMP:
474 		data->val_temp = val;
475 		break;
476 	case SHT15_READING_HUMID:
477 		data->val_humid = val;
478 		break;
479 	}
480 
481 	data->flag = SHT15_READING_NOTHING;
482 	wake_up(&data->wait_queue);
483 }
484 
485 static void sht15_update_voltage(struct work_struct *work_s)
486 {
487 	struct sht15_data *data
488 		= container_of(work_s, struct sht15_data,
489 			       update_supply_work);
490 	data->supply_uV = regulator_get_voltage(data->reg);
491 }
492 
493 /**
494  * sht15_invalidate_voltage() - mark supply voltage invalid when notified by reg
495  * @nb:		associated notification structure
496  * @event:	voltage regulator state change event code
497  * @ignored:	function parameter - ignored here
498  *
499  * Note that as the notification code holds the regulator lock, we have
500  * to schedule an update of the supply voltage rather than getting it directly.
501  **/
502 static int sht15_invalidate_voltage(struct notifier_block *nb,
503 				unsigned long event,
504 				void *ignored)
505 {
506 	struct sht15_data *data = container_of(nb, struct sht15_data, nb);
507 
508 	if (event == REGULATOR_EVENT_VOLTAGE_CHANGE)
509 		data->supply_uV_valid = false;
510 	schedule_work(&data->update_supply_work);
511 
512 	return NOTIFY_OK;
513 }
514 
515 static int __devinit sht15_probe(struct platform_device *pdev)
516 {
517 	int ret = 0;
518 	struct sht15_data *data = kzalloc(sizeof(*data), GFP_KERNEL);
519 
520 	if (!data) {
521 		ret = -ENOMEM;
522 		dev_err(&pdev->dev, "kzalloc failed");
523 		goto error_ret;
524 	}
525 
526 	INIT_WORK(&data->read_work, sht15_bh_read_data);
527 	INIT_WORK(&data->update_supply_work, sht15_update_voltage);
528 	platform_set_drvdata(pdev, data);
529 	mutex_init(&data->read_lock);
530 	data->dev = &pdev->dev;
531 	init_waitqueue_head(&data->wait_queue);
532 
533 	if (pdev->dev.platform_data == NULL) {
534 		dev_err(&pdev->dev, "no platform data supplied");
535 		goto err_free_data;
536 	}
537 	data->pdata = pdev->dev.platform_data;
538 	data->supply_uV = data->pdata->supply_mv*1000;
539 
540 /* If a regulator is available, query what the supply voltage actually is!*/
541 	data->reg = regulator_get(data->dev, "vcc");
542 	if (!IS_ERR(data->reg)) {
543 		data->supply_uV = regulator_get_voltage(data->reg);
544 		regulator_enable(data->reg);
545 		/* setup a notifier block to update this if another device
546 		 *  causes the voltage to change */
547 		data->nb.notifier_call = &sht15_invalidate_voltage;
548 		ret = regulator_register_notifier(data->reg, &data->nb);
549 	}
550 /* Try requesting the GPIOs */
551 	ret = gpio_request(data->pdata->gpio_sck, "SHT15 sck");
552 	if (ret) {
553 		dev_err(&pdev->dev, "gpio request failed");
554 		goto err_free_data;
555 	}
556 	gpio_direction_output(data->pdata->gpio_sck, 0);
557 	ret = gpio_request(data->pdata->gpio_data, "SHT15 data");
558 	if (ret) {
559 		dev_err(&pdev->dev, "gpio request failed");
560 		goto err_release_gpio_sck;
561 	}
562 	ret = sysfs_create_group(&pdev->dev.kobj, &sht15_attr_group);
563 	if (ret) {
564 		dev_err(&pdev->dev, "sysfs create failed");
565 		goto err_free_data;
566 	}
567 
568 	ret = request_irq(gpio_to_irq(data->pdata->gpio_data),
569 			  sht15_interrupt_fired,
570 			  IRQF_TRIGGER_FALLING,
571 			  "sht15 data",
572 			  data);
573 	if (ret) {
574 		dev_err(&pdev->dev, "failed to get irq for data line");
575 		goto err_release_gpio_data;
576 	}
577 	disable_irq_nosync(gpio_to_irq(data->pdata->gpio_data));
578 	sht15_connection_reset(data);
579 	sht15_send_cmd(data, 0x1E);
580 
581 	data->hwmon_dev = hwmon_device_register(data->dev);
582 	if (IS_ERR(data->hwmon_dev)) {
583 		ret = PTR_ERR(data->hwmon_dev);
584 		goto err_release_gpio_data;
585 	}
586 	return 0;
587 
588 err_release_gpio_data:
589 	gpio_free(data->pdata->gpio_data);
590 err_release_gpio_sck:
591 	gpio_free(data->pdata->gpio_sck);
592 err_free_data:
593 	kfree(data);
594 error_ret:
595 
596 	return ret;
597 }
598 
599 static int __devexit sht15_remove(struct platform_device *pdev)
600 {
601 	struct sht15_data *data = platform_get_drvdata(pdev);
602 
603 	/* Make sure any reads from the device are done and
604 	 * prevent new ones beginnning */
605 	mutex_lock(&data->read_lock);
606 	hwmon_device_unregister(data->hwmon_dev);
607 	sysfs_remove_group(&pdev->dev.kobj, &sht15_attr_group);
608 	if (!IS_ERR(data->reg)) {
609 		regulator_unregister_notifier(data->reg, &data->nb);
610 		regulator_disable(data->reg);
611 		regulator_put(data->reg);
612 	}
613 
614 	free_irq(gpio_to_irq(data->pdata->gpio_data), data);
615 	gpio_free(data->pdata->gpio_data);
616 	gpio_free(data->pdata->gpio_sck);
617 	mutex_unlock(&data->read_lock);
618 	kfree(data);
619 	return 0;
620 }
621 
622 
623 static struct platform_driver sht_drivers[] = {
624 	{
625 		.driver = {
626 			.name = "sht10",
627 			.owner = THIS_MODULE,
628 		},
629 		.probe = sht15_probe,
630 		.remove = sht15_remove,
631 	}, {
632 		.driver = {
633 			.name = "sht11",
634 			.owner = THIS_MODULE,
635 		},
636 		.probe = sht15_probe,
637 		.remove = sht15_remove,
638 	}, {
639 		.driver = {
640 			.name = "sht15",
641 			.owner = THIS_MODULE,
642 		},
643 		.probe = sht15_probe,
644 		.remove = sht15_remove,
645 	}, {
646 		.driver = {
647 			.name = "sht71",
648 			.owner = THIS_MODULE,
649 		},
650 		.probe = sht15_probe,
651 		.remove = sht15_remove,
652 	}, {
653 		.driver = {
654 			.name = "sht75",
655 			.owner = THIS_MODULE,
656 		},
657 		.probe = sht15_probe,
658 		.remove = sht15_remove,
659 	},
660 };
661 
662 
663 static int __init sht15_init(void)
664 {
665 	int ret;
666 	int i;
667 
668 	for (i = 0; i < ARRAY_SIZE(sht_drivers); i++) {
669 		ret = platform_driver_register(&sht_drivers[i]);
670 		if (ret)
671 			goto error_unreg;
672 	}
673 
674 	return 0;
675 
676 error_unreg:
677 	while (--i >= 0)
678 		platform_driver_unregister(&sht_drivers[i]);
679 
680 	return ret;
681 }
682 module_init(sht15_init);
683 
684 static void __exit sht15_exit(void)
685 {
686 	int i;
687 	for (i = ARRAY_SIZE(sht_drivers) - 1; i >= 0; i--)
688 		platform_driver_unregister(&sht_drivers[i]);
689 }
690 module_exit(sht15_exit);
691 
692 MODULE_LICENSE("GPL");
693