128 static s16 lis3lv02d_read_8(struct lis3lv02d *lis3, int reg)  in lis3lv02d_read_8()  argument
131 	if (lis3->read(lis3, reg, &lo) < 0)  in lis3lv02d_read_8()
137 static s16 lis3lv02d_read_12(struct lis3lv02d *lis3, int reg)  in lis3lv02d_read_12()  argument
141 	lis3->read(lis3, reg - 1, &lo);  in lis3lv02d_read_12()
142 	lis3->read(lis3, reg, &hi);  in lis3lv02d_read_12()
148 static s16 lis331dlh_read_data(struct lis3lv02d *lis3, int reg)  in lis331dlh_read_data()  argument
153 	lis3->read(lis3, reg - 1, &lo);  in lis331dlh_read_data()
154 	lis3->read(lis3, reg, &hi);  in lis331dlh_read_data()
157 	return (s16) v >> lis3->shift_adj;  in lis331dlh_read_data()
184 static void lis3lv02d_get_xyz(struct lis3lv02d *lis3, int *x, int *y, int *z)  in lis3lv02d_get_xyz()  argument
189 	if (lis3->blkread) {  in lis3lv02d_get_xyz()
190 		if (lis3->whoami == WAI_12B) {  in lis3lv02d_get_xyz()
192 			lis3->blkread(lis3, OUTX_L, 6, (u8 *)data);  in lis3lv02d_get_xyz()
198 			lis3->blkread(lis3, OUTX, 5, data);  in lis3lv02d_get_xyz()
203 		position[0] = lis3->read_data(lis3, OUTX);  in lis3lv02d_get_xyz()
204 		position[1] = lis3->read_data(lis3, OUTY);  in lis3lv02d_get_xyz()
205 		position[2] = lis3->read_data(lis3, OUTZ);  in lis3lv02d_get_xyz()
209 		position[i] = (position[i] * lis3->scale) / LIS3_ACCURACY;  in lis3lv02d_get_xyz()
211 	*x = lis3lv02d_get_axis(lis3->ac.x, position);  in lis3lv02d_get_xyz()
212 	*y = lis3lv02d_get_axis(lis3->ac.y, position);  in lis3lv02d_get_xyz()
213 	*z = lis3lv02d_get_axis(lis3->ac.z, position);  in lis3lv02d_get_xyz()
223 static int lis3lv02d_get_odr(struct lis3lv02d *lis3)  in lis3lv02d_get_odr()  argument
228 	lis3->read(lis3, CTRL_REG1, &ctrl);  in lis3lv02d_get_odr()
229 	ctrl &= lis3->odr_mask;  in lis3lv02d_get_odr()
230 	shift = ffs(lis3->odr_mask) - 1;  in lis3lv02d_get_odr()
231 	return lis3->odrs[(ctrl >> shift)];  in lis3lv02d_get_odr()
234 static int lis3lv02d_get_pwron_wait(struct lis3lv02d *lis3)  in lis3lv02d_get_pwron_wait()  argument
236 	int div = lis3lv02d_get_odr(lis3);  in lis3lv02d_get_pwron_wait()
242 	msleep(lis3->pwron_delay / div);  in lis3lv02d_get_pwron_wait()
246 static int lis3lv02d_set_odr(struct lis3lv02d *lis3, int rate)  in lis3lv02d_set_odr()  argument
254 	lis3->read(lis3, CTRL_REG1, &ctrl);  in lis3lv02d_set_odr()
255 	ctrl &= ~lis3->odr_mask;  in lis3lv02d_set_odr()
256 	len = 1 << hweight_long(lis3->odr_mask); /* # of possible values */  in lis3lv02d_set_odr()
257 	shift = ffs(lis3->odr_mask) - 1;  in lis3lv02d_set_odr()
260 		if (lis3->odrs[i] == rate) {  in lis3lv02d_set_odr()
261 			lis3->write(lis3, CTRL_REG1,  in lis3lv02d_set_odr()
268 static int lis3lv02d_selftest(struct lis3lv02d *lis3, s16 results[3])  in lis3lv02d_selftest()  argument
277 	mutex_lock(&lis3->mutex);  in lis3lv02d_selftest()
279 	irq_cfg = lis3->irq_cfg;  in lis3lv02d_selftest()
280 	if (lis3->whoami == WAI_8B) {  in lis3lv02d_selftest()
281 		lis3->data_ready_count[IRQ_LINE0] = 0;  in lis3lv02d_selftest()
282 		lis3->data_ready_count[IRQ_LINE1] = 0;  in lis3lv02d_selftest()
285 		atomic_inc(&lis3->wake_thread);  in lis3lv02d_selftest()
286 		lis3->irq_cfg = LIS3_IRQ1_DATA_READY | LIS3_IRQ2_DATA_READY;  in lis3lv02d_selftest()
287 		lis3->read(lis3, CTRL_REG3, &ctrl_reg_data);  in lis3lv02d_selftest()
288 		lis3->write(lis3, CTRL_REG3, (ctrl_reg_data &  in lis3lv02d_selftest()
293 	if ((lis3->whoami == WAI_3DC) || (lis3->whoami == WAI_3DLH)) {  in lis3lv02d_selftest()
298 		if (lis3->whoami == WAI_12B)  in lis3lv02d_selftest()
304 	lis3->read(lis3, ctlreg, &reg);  in lis3lv02d_selftest()
305 	lis3->write(lis3, ctlreg, (reg | selftest));  in lis3lv02d_selftest()
306 	ret = lis3lv02d_get_pwron_wait(lis3);  in lis3lv02d_selftest()
311 	x = lis3->read_data(lis3, OUTX);  in lis3lv02d_selftest()
312 	y = lis3->read_data(lis3, OUTY);  in lis3lv02d_selftest()
313 	z = lis3->read_data(lis3, OUTZ);  in lis3lv02d_selftest()
316 	lis3->write(lis3, ctlreg, reg);  in lis3lv02d_selftest()
317 	ret = lis3lv02d_get_pwron_wait(lis3);  in lis3lv02d_selftest()
321 	results[0] = x - lis3->read_data(lis3, OUTX);  in lis3lv02d_selftest()
322 	results[1] = y - lis3->read_data(lis3, OUTY);  in lis3lv02d_selftest()
323 	results[2] = z - lis3->read_data(lis3, OUTZ);  in lis3lv02d_selftest()
327 	if (lis3->whoami == WAI_8B) {  in lis3lv02d_selftest()
329 		atomic_dec(&lis3->wake_thread);  in lis3lv02d_selftest()
330 		lis3->write(lis3, CTRL_REG3, ctrl_reg_data);  in lis3lv02d_selftest()
331 		lis3->irq_cfg = irq_cfg;  in lis3lv02d_selftest()
334 			lis3->data_ready_count[IRQ_LINE0] < 2) {  in lis3lv02d_selftest()
340 			lis3->data_ready_count[IRQ_LINE1] < 2) {  in lis3lv02d_selftest()
346 	if (lis3->pdata) {  in lis3lv02d_selftest()
350 			if ((results[i] < lis3->pdata->st_min_limits[i]) ||  in lis3lv02d_selftest()
351 			    (results[i] > lis3->pdata->st_max_limits[i])) {  in lis3lv02d_selftest()
360 	mutex_unlock(&lis3->mutex);  in lis3lv02d_selftest()
380 static inline void lis3_context_save(struct lis3lv02d *lis3)  in lis3_context_save()  argument
383 	for (i = 0; i < lis3->regs_size; i++)  in lis3_context_save()
384 		lis3->read(lis3, lis3->regs[i], &lis3->reg_cache[i]);  in lis3_context_save()
385 	lis3->regs_stored = true;  in lis3_context_save()
388 static inline void lis3_context_restore(struct lis3lv02d *lis3)  in lis3_context_restore()  argument
391 	if (lis3->regs_stored)  in lis3_context_restore()
392 		for (i = 0; i < lis3->regs_size; i++)  in lis3_context_restore()
393 			lis3->write(lis3, lis3->regs[i], lis3->reg_cache[i]);  in lis3_context_restore()
396 void lis3lv02d_poweroff(struct lis3lv02d *lis3)  in lis3lv02d_poweroff()  argument
398 	if (lis3->reg_ctrl)  in lis3lv02d_poweroff()
399 		lis3_context_save(lis3);  in lis3lv02d_poweroff()
401 	lis3->write(lis3, CTRL_REG1, 0x00);  in lis3lv02d_poweroff()
402 	if (lis3->reg_ctrl)  in lis3lv02d_poweroff()
403 		lis3->reg_ctrl(lis3, LIS3_REG_OFF);  in lis3lv02d_poweroff()
407 int lis3lv02d_poweron(struct lis3lv02d *lis3)  in lis3lv02d_poweron()  argument
412 	lis3->init(lis3);  in lis3lv02d_poweron()
420 	if (lis3->pdata) {  in lis3lv02d_poweron()
421 		lis3->read(lis3, CTRL_REG2, &reg);  in lis3lv02d_poweron()
422 		if (lis3->whoami ==  WAI_12B)  in lis3lv02d_poweron()
424 		else if (lis3->whoami ==  WAI_3DLH)  in lis3lv02d_poweron()
428 		lis3->write(lis3, CTRL_REG2, reg);  in lis3lv02d_poweron()
430 		if (lis3->whoami ==  WAI_3DLH) {  in lis3lv02d_poweron()
431 			lis3->read(lis3, CTRL_REG4, &reg);  in lis3lv02d_poweron()
433 			lis3->write(lis3, CTRL_REG4, reg);  in lis3lv02d_poweron()
437 	err = lis3lv02d_get_pwron_wait(lis3);  in lis3lv02d_poweron()
441 	if (lis3->reg_ctrl)  in lis3lv02d_poweron()
442 		lis3_context_restore(lis3);  in lis3lv02d_poweron()
451 	struct lis3lv02d *lis3 = pidev->private;  in lis3lv02d_joystick_poll()  local
454 	mutex_lock(&lis3->mutex);  in lis3lv02d_joystick_poll()
455 	lis3lv02d_get_xyz(lis3, &x, &y, &z);  in lis3lv02d_joystick_poll()
460 	mutex_unlock(&lis3->mutex);  in lis3lv02d_joystick_poll()
465 	struct lis3lv02d *lis3 = pidev->private;  in lis3lv02d_joystick_open()  local
467 	if (lis3->pm_dev)  in lis3lv02d_joystick_open()
468 		pm_runtime_get_sync(lis3->pm_dev);  in lis3lv02d_joystick_open()
470 	if (lis3->pdata && lis3->whoami == WAI_8B && lis3->idev)  in lis3lv02d_joystick_open()
471 		atomic_set(&lis3->wake_thread, 1);  in lis3lv02d_joystick_open()
481 	struct lis3lv02d *lis3 = pidev->private;  in lis3lv02d_joystick_close()  local
483 	atomic_set(&lis3->wake_thread, 0);  in lis3lv02d_joystick_close()
484 	if (lis3->pm_dev)  in lis3lv02d_joystick_close()
485 		pm_runtime_put(lis3->pm_dev);  in lis3lv02d_joystick_close()
490 	struct lis3lv02d *lis3 = data;  in lis302dl_interrupt()  local
492 	if (!test_bit(0, &lis3->misc_opened))  in lis302dl_interrupt()
500 	atomic_inc(&lis3->count);  in lis302dl_interrupt()
502 	wake_up_interruptible(&lis3->misc_wait);  in lis302dl_interrupt()
503 	kill_fasync(&lis3->async_queue, SIGIO, POLL_IN);  in lis302dl_interrupt()
505 	if (atomic_read(&lis3->wake_thread))  in lis302dl_interrupt()
510 static void lis302dl_interrupt_handle_click(struct lis3lv02d *lis3)  in lis302dl_interrupt_handle_click()  argument
512 	struct input_dev *dev = lis3->idev->input;  in lis302dl_interrupt_handle_click()
515 	mutex_lock(&lis3->mutex);  in lis302dl_interrupt_handle_click()
516 	lis3->read(lis3, CLICK_SRC, &click_src);  in lis302dl_interrupt_handle_click()
519 		input_report_key(dev, lis3->mapped_btns[0], 1);  in lis302dl_interrupt_handle_click()
520 		input_report_key(dev, lis3->mapped_btns[0], 0);  in lis302dl_interrupt_handle_click()
524 		input_report_key(dev, lis3->mapped_btns[1], 1);  in lis302dl_interrupt_handle_click()
525 		input_report_key(dev, lis3->mapped_btns[1], 0);  in lis302dl_interrupt_handle_click()
529 		input_report_key(dev, lis3->mapped_btns[2], 1);  in lis302dl_interrupt_handle_click()
530 		input_report_key(dev, lis3->mapped_btns[2], 0);  in lis302dl_interrupt_handle_click()
533 	mutex_unlock(&lis3->mutex);  in lis302dl_interrupt_handle_click()
536 static inline void lis302dl_data_ready(struct lis3lv02d *lis3, int index)  in lis302dl_data_ready()  argument
541 	lis3lv02d_get_xyz(lis3, &dummy, &dummy, &dummy);  in lis302dl_data_ready()
542 	lis3->data_ready_count[index]++;  in lis302dl_data_ready()
547 	struct lis3lv02d *lis3 = data;  in lis302dl_interrupt_thread1_8b()  local
548 	u8 irq_cfg = lis3->irq_cfg & LIS3_IRQ1_MASK;  in lis302dl_interrupt_thread1_8b()
551 		lis302dl_interrupt_handle_click(lis3);  in lis302dl_interrupt_thread1_8b()
553 		lis302dl_data_ready(lis3, IRQ_LINE0);  in lis302dl_interrupt_thread1_8b()
555 		lis3lv02d_joystick_poll(lis3->idev);  in lis302dl_interrupt_thread1_8b()
562 	struct lis3lv02d *lis3 = data;  in lis302dl_interrupt_thread2_8b()  local
563 	u8 irq_cfg = lis3->irq_cfg & LIS3_IRQ2_MASK;  in lis302dl_interrupt_thread2_8b()
566 		lis302dl_interrupt_handle_click(lis3);  in lis302dl_interrupt_thread2_8b()
568 		lis302dl_data_ready(lis3, IRQ_LINE1);  in lis302dl_interrupt_thread2_8b()
570 		lis3lv02d_joystick_poll(lis3->idev);  in lis302dl_interrupt_thread2_8b()
577 	struct lis3lv02d *lis3 = container_of(file->private_data,  in lis3lv02d_misc_open()  local
580 	if (test_and_set_bit(0, &lis3->misc_opened))  in lis3lv02d_misc_open()
583 	if (lis3->pm_dev)  in lis3lv02d_misc_open()
584 		pm_runtime_get_sync(lis3->pm_dev);  in lis3lv02d_misc_open()
586 	atomic_set(&lis3->count, 0);  in lis3lv02d_misc_open()
592 	struct lis3lv02d *lis3 = container_of(file->private_data,  in lis3lv02d_misc_release()  local
595 	clear_bit(0, &lis3->misc_opened); /* release the device */  in lis3lv02d_misc_release()
596 	if (lis3->pm_dev)  in lis3lv02d_misc_release()
597 		pm_runtime_put(lis3->pm_dev);  in lis3lv02d_misc_release()
604 	struct lis3lv02d *lis3 = container_of(file->private_data,  in lis3lv02d_misc_read()  local
615 	add_wait_queue(&lis3->misc_wait, &wait);  in lis3lv02d_misc_read()
618 		data = atomic_xchg(&lis3->count, 0);  in lis3lv02d_misc_read()
648 	remove_wait_queue(&lis3->misc_wait, &wait);  in lis3lv02d_misc_read()
655 	struct lis3lv02d *lis3 = container_of(file->private_data,  in lis3lv02d_misc_poll()  local
658 	poll_wait(file, &lis3->misc_wait, wait);  in lis3lv02d_misc_poll()
659 	if (atomic_read(&lis3->count))  in lis3lv02d_misc_poll()
666 	struct lis3lv02d *lis3 = container_of(file->private_data,  in lis3lv02d_misc_fasync()  local
669 	return fasync_helper(fd, file, on, &lis3->async_queue);  in lis3lv02d_misc_fasync()
682 int lis3lv02d_joystick_enable(struct lis3lv02d *lis3)  in lis3lv02d_joystick_enable()  argument
689 	if (lis3->idev)  in lis3lv02d_joystick_enable()
692 	lis3->idev = input_allocate_polled_device();  in lis3lv02d_joystick_enable()
693 	if (!lis3->idev)  in lis3lv02d_joystick_enable()
696 	lis3->idev->poll = lis3lv02d_joystick_poll;  in lis3lv02d_joystick_enable()
697 	lis3->idev->open = lis3lv02d_joystick_open;  in lis3lv02d_joystick_enable()
698 	lis3->idev->close = lis3lv02d_joystick_close;  in lis3lv02d_joystick_enable()
699 	lis3->idev->poll_interval = MDPS_POLL_INTERVAL;  in lis3lv02d_joystick_enable()
700 	lis3->idev->poll_interval_min = MDPS_POLL_MIN;  in lis3lv02d_joystick_enable()
701 	lis3->idev->poll_interval_max = MDPS_POLL_MAX;  in lis3lv02d_joystick_enable()
702 	lis3->idev->private = lis3;  in lis3lv02d_joystick_enable()
703 	input_dev = lis3->idev->input;  in lis3lv02d_joystick_enable()
709 	input_dev->dev.parent = &lis3->pdev->dev;  in lis3lv02d_joystick_enable()
712 	max_val = (lis3->mdps_max_val * lis3->scale) / LIS3_ACCURACY;  in lis3lv02d_joystick_enable()
713 	if (lis3->whoami == WAI_12B) {  in lis3lv02d_joystick_enable()
720 	fuzz = (fuzz * lis3->scale) / LIS3_ACCURACY;  in lis3lv02d_joystick_enable()
721 	flat = (flat * lis3->scale) / LIS3_ACCURACY;  in lis3lv02d_joystick_enable()
727 	lis3->mapped_btns[0] = lis3lv02d_get_axis(abs(lis3->ac.x), btns);  in lis3lv02d_joystick_enable()
728 	lis3->mapped_btns[1] = lis3lv02d_get_axis(abs(lis3->ac.y), btns);  in lis3lv02d_joystick_enable()
729 	lis3->mapped_btns[2] = lis3lv02d_get_axis(abs(lis3->ac.z), btns);  in lis3lv02d_joystick_enable()
731 	err = input_register_polled_device(lis3->idev);  in lis3lv02d_joystick_enable()
733 		input_free_polled_device(lis3->idev);  in lis3lv02d_joystick_enable()
734 		lis3->idev = NULL;  in lis3lv02d_joystick_enable()
741 void lis3lv02d_joystick_disable(struct lis3lv02d *lis3)  in lis3lv02d_joystick_disable()  argument
743 	if (lis3->irq)  in lis3lv02d_joystick_disable()
744 		free_irq(lis3->irq, lis3);  in lis3lv02d_joystick_disable()
745 	if (lis3->pdata && lis3->pdata->irq2)  in lis3lv02d_joystick_disable()
746 		free_irq(lis3->pdata->irq2, lis3);  in lis3lv02d_joystick_disable()
748 	if (!lis3->idev)  in lis3lv02d_joystick_disable()
751 	if (lis3->irq)  in lis3lv02d_joystick_disable()
752 		misc_deregister(&lis3->miscdev);  in lis3lv02d_joystick_disable()
753 	input_unregister_polled_device(lis3->idev);  in lis3lv02d_joystick_disable()
754 	input_free_polled_device(lis3->idev);  in lis3lv02d_joystick_disable()
755 	lis3->idev = NULL;  in lis3lv02d_joystick_disable()
760 static void lis3lv02d_sysfs_poweron(struct lis3lv02d *lis3)  in lis3lv02d_sysfs_poweron()  argument
770 	if (lis3->pm_dev) {  in lis3lv02d_sysfs_poweron()
771 		pm_runtime_get_sync(lis3->pm_dev);  in lis3lv02d_sysfs_poweron()
772 		pm_runtime_put_noidle(lis3->pm_dev);  in lis3lv02d_sysfs_poweron()
773 		pm_schedule_suspend(lis3->pm_dev, LIS3_SYSFS_POWERDOWN_DELAY);  in lis3lv02d_sysfs_poweron()
780 	struct lis3lv02d *lis3 = dev_get_drvdata(dev);  in lis3lv02d_selftest_show()  local
788 	lis3lv02d_sysfs_poweron(lis3);  in lis3lv02d_selftest_show()
789 	switch (lis3lv02d_selftest(lis3, values)) {  in lis3lv02d_selftest_show()
808 	struct lis3lv02d *lis3 = dev_get_drvdata(dev);  in lis3lv02d_position_show()  local
811 	lis3lv02d_sysfs_poweron(lis3);  in lis3lv02d_position_show()
812 	mutex_lock(&lis3->mutex);  in lis3lv02d_position_show()
813 	lis3lv02d_get_xyz(lis3, &x, &y, &z);  in lis3lv02d_position_show()
814 	mutex_unlock(&lis3->mutex);  in lis3lv02d_position_show()
821 	struct lis3lv02d *lis3 = dev_get_drvdata(dev);  in lis3lv02d_rate_show()  local
823 	lis3lv02d_sysfs_poweron(lis3);  in lis3lv02d_rate_show()
824 	return sprintf(buf, "%d\n", lis3lv02d_get_odr(lis3));  in lis3lv02d_rate_show()
831 	struct lis3lv02d *lis3 = dev_get_drvdata(dev);  in lis3lv02d_rate_set()  local
839 	lis3lv02d_sysfs_poweron(lis3);  in lis3lv02d_rate_set()
840 	if (lis3lv02d_set_odr(lis3, rate))  in lis3lv02d_rate_set()
863 static int lis3lv02d_add_fs(struct lis3lv02d *lis3)  in lis3lv02d_add_fs()  argument
865 	lis3->pdev = platform_device_register_simple(DRIVER_NAME, -1, NULL, 0);  in lis3lv02d_add_fs()
866 	if (IS_ERR(lis3->pdev))  in lis3lv02d_add_fs()
867 		return PTR_ERR(lis3->pdev);  in lis3lv02d_add_fs()
869 	platform_set_drvdata(lis3->pdev, lis3);  in lis3lv02d_add_fs()
870 	return sysfs_create_group(&lis3->pdev->dev.kobj, &lis3lv02d_attribute_group);  in lis3lv02d_add_fs()
873 int lis3lv02d_remove_fs(struct lis3lv02d *lis3)  in lis3lv02d_remove_fs()  argument
875 	sysfs_remove_group(&lis3->pdev->dev.kobj, &lis3lv02d_attribute_group);  in lis3lv02d_remove_fs()
876 	platform_device_unregister(lis3->pdev);  in lis3lv02d_remove_fs()
877 	if (lis3->pm_dev) {  in lis3lv02d_remove_fs()
879 		pm_runtime_barrier(lis3->pm_dev);  in lis3lv02d_remove_fs()
882 		if (!pm_runtime_suspended(lis3->pm_dev))  in lis3lv02d_remove_fs()
883 			lis3lv02d_poweroff(lis3);  in lis3lv02d_remove_fs()
885 		pm_runtime_disable(lis3->pm_dev);  in lis3lv02d_remove_fs()
886 		pm_runtime_set_suspended(lis3->pm_dev);  in lis3lv02d_remove_fs()
888 	kfree(lis3->reg_cache);  in lis3lv02d_remove_fs()
893 static void lis3lv02d_8b_configure(struct lis3lv02d *lis3,  in lis3lv02d_8b_configure()  argument
900 		lis3->write(lis3, CLICK_CFG, p->click_flags);  in lis3lv02d_8b_configure()
901 		lis3->write(lis3, CLICK_TIMELIMIT, p->click_time_limit);  in lis3lv02d_8b_configure()
902 		lis3->write(lis3, CLICK_LATENCY, p->click_latency);  in lis3lv02d_8b_configure()
903 		lis3->write(lis3, CLICK_WINDOW, p->click_window);  in lis3lv02d_8b_configure()
904 		lis3->write(lis3, CLICK_THSZ, p->click_thresh_z & 0xf);  in lis3lv02d_8b_configure()
905 		lis3->write(lis3, CLICK_THSY_X,  in lis3lv02d_8b_configure()
909 		if (lis3->idev) {  in lis3lv02d_8b_configure()
910 			struct input_dev *input_dev = lis3->idev->input;  in lis3lv02d_8b_configure()
918 		lis3->write(lis3, FF_WU_CFG_1, p->wakeup_flags);  in lis3lv02d_8b_configure()
919 		lis3->write(lis3, FF_WU_THS_1, p->wakeup_thresh & 0x7f);  in lis3lv02d_8b_configure()
921 		lis3->write(lis3, FF_WU_DURATION_1, p->duration1 + 1);  in lis3lv02d_8b_configure()
926 		lis3->write(lis3, FF_WU_CFG_2, p->wakeup_flags2);  in lis3lv02d_8b_configure()
927 		lis3->write(lis3, FF_WU_THS_2, p->wakeup_thresh2 & 0x7f);  in lis3lv02d_8b_configure()
929 		lis3->write(lis3, FF_WU_DURATION_2, p->duration2 + 1);  in lis3lv02d_8b_configure()
933 	lis3->write(lis3, CTRL_REG2, ctrl2);  in lis3lv02d_8b_configure()
941 					DRIVER_NAME, lis3);  in lis3lv02d_8b_configure()
948 int lis3lv02d_init_dt(struct lis3lv02d *lis3)  in lis3lv02d_init_dt()  argument
951 	struct device_node *np = lis3->of_node;  in lis3lv02d_init_dt()
955 	if (!lis3->of_node)  in lis3lv02d_init_dt()
1100 	lis3->pdata = pdata;  in lis3lv02d_init_dt()
1106 int lis3lv02d_init_dt(struct lis3lv02d *lis3)  in lis3lv02d_init_dt()  argument
1117 int lis3lv02d_init_device(struct lis3lv02d *lis3)  in lis3lv02d_init_device()  argument
1123 	lis3->whoami = lis3lv02d_read_8(lis3, WHO_AM_I);  in lis3lv02d_init_device()
1125 	switch (lis3->whoami) {  in lis3lv02d_init_device()
1128 		lis3->read_data = lis3lv02d_read_12;  in lis3lv02d_init_device()
1129 		lis3->mdps_max_val = 2048;  in lis3lv02d_init_device()
1130 		lis3->pwron_delay = LIS3_PWRON_DELAY_WAI_12B;  in lis3lv02d_init_device()
1131 		lis3->odrs = lis3_12_rates;  in lis3lv02d_init_device()
1132 		lis3->odr_mask = CTRL1_DF0 | CTRL1_DF1;  in lis3lv02d_init_device()
1133 		lis3->scale = LIS3_SENSITIVITY_12B;  in lis3lv02d_init_device()
1134 		lis3->regs = lis3_wai12_regs;  in lis3lv02d_init_device()
1135 		lis3->regs_size = ARRAY_SIZE(lis3_wai12_regs);  in lis3lv02d_init_device()
1139 		lis3->read_data = lis3lv02d_read_8;  in lis3lv02d_init_device()
1140 		lis3->mdps_max_val = 128;  in lis3lv02d_init_device()
1141 		lis3->pwron_delay = LIS3_PWRON_DELAY_WAI_8B;  in lis3lv02d_init_device()
1142 		lis3->odrs = lis3_8_rates;  in lis3lv02d_init_device()
1143 		lis3->odr_mask = CTRL1_DR;  in lis3lv02d_init_device()
1144 		lis3->scale = LIS3_SENSITIVITY_8B;  in lis3lv02d_init_device()
1145 		lis3->regs = lis3_wai8_regs;  in lis3lv02d_init_device()
1146 		lis3->regs_size = ARRAY_SIZE(lis3_wai8_regs);  in lis3lv02d_init_device()
1150 		lis3->read_data = lis3lv02d_read_8;  in lis3lv02d_init_device()
1151 		lis3->mdps_max_val = 128;  in lis3lv02d_init_device()
1152 		lis3->pwron_delay = LIS3_PWRON_DELAY_WAI_8B;  in lis3lv02d_init_device()
1153 		lis3->odrs = lis3_3dc_rates;  in lis3lv02d_init_device()
1154 		lis3->odr_mask = CTRL1_ODR0|CTRL1_ODR1|CTRL1_ODR2|CTRL1_ODR3;  in lis3lv02d_init_device()
1155 		lis3->scale = LIS3_SENSITIVITY_8B;  in lis3lv02d_init_device()
1159 		lis3->read_data = lis331dlh_read_data;  in lis3lv02d_init_device()
1160 		lis3->mdps_max_val = 2048; /* 12 bits for 2G */  in lis3lv02d_init_device()
1161 		lis3->shift_adj = SHIFT_ADJ_2G;  in lis3lv02d_init_device()
1162 		lis3->pwron_delay = LIS3_PWRON_DELAY_WAI_8B;  in lis3lv02d_init_device()
1163 		lis3->odrs = lis3_3dlh_rates;  in lis3lv02d_init_device()
1164 		lis3->odr_mask = CTRL1_DR0 | CTRL1_DR1;  in lis3lv02d_init_device()
1165 		lis3->scale = LIS3DLH_SENSITIVITY_2G;  in lis3lv02d_init_device()
1168 		pr_err("unknown sensor type 0x%X\n", lis3->whoami);  in lis3lv02d_init_device()
1172 	lis3->reg_cache = kzalloc(max(sizeof(lis3_wai8_regs),  in lis3lv02d_init_device()
1175 	if (lis3->reg_cache == NULL) {  in lis3lv02d_init_device()
1180 	mutex_init(&lis3->mutex);  in lis3lv02d_init_device()
1181 	atomic_set(&lis3->wake_thread, 0);  in lis3lv02d_init_device()
1183 	lis3lv02d_add_fs(lis3);  in lis3lv02d_init_device()
1184 	err = lis3lv02d_poweron(lis3);  in lis3lv02d_init_device()
1186 		lis3lv02d_remove_fs(lis3);  in lis3lv02d_init_device()
1190 	if (lis3->pm_dev) {  in lis3lv02d_init_device()
1191 		pm_runtime_set_active(lis3->pm_dev);  in lis3lv02d_init_device()
1192 		pm_runtime_enable(lis3->pm_dev);  in lis3lv02d_init_device()
1195 	if (lis3lv02d_joystick_enable(lis3))  in lis3lv02d_init_device()
1200 	if (lis3->pdata) {  in lis3lv02d_init_device()
1201 		struct lis3lv02d_platform_data *p = lis3->pdata;  in lis3lv02d_init_device()
1203 		if (lis3->whoami == WAI_8B)  in lis3lv02d_init_device()
1204 			lis3lv02d_8b_configure(lis3, p);  in lis3lv02d_init_device()
1208 		lis3->irq_cfg = p->irq_cfg;  in lis3lv02d_init_device()
1210 			lis3->write(lis3, CTRL_REG3, p->irq_cfg);  in lis3lv02d_init_device()
1213 			lis3lv02d_set_odr(lis3, p->default_rate);  in lis3lv02d_init_device()
1217 	if (!lis3->irq) {  in lis3lv02d_init_device()
1233 	if (lis3->pdata && lis3->whoami == WAI_8B)  in lis3lv02d_init_device()
1238 	err = request_threaded_irq(lis3->irq, lis302dl_interrupt,  in lis3lv02d_init_device()
1242 				DRIVER_NAME, lis3);  in lis3lv02d_init_device()
1249 	lis3->miscdev.minor	= MISC_DYNAMIC_MINOR;  in lis3lv02d_init_device()
1250 	lis3->miscdev.name	= "freefall";  in lis3lv02d_init_device()
1251 	lis3->miscdev.fops	= &lis3lv02d_misc_fops;  in lis3lv02d_init_device()
1253 	if (misc_register(&lis3->miscdev))  in lis3lv02d_init_device()