Daniel Mack | bb233fd | 2009-03-31 15:24:33 -0700 | [diff] [blame] | 1 | /* |
| 2 | * lis3lv02d_spi - SPI glue layer for lis3lv02d |
| 3 | * |
| 4 | * Copyright (c) 2009 Daniel Mack <daniel@caiaq.de> |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License version 2 as |
| 8 | * publishhed by the Free Software Foundation. |
| 9 | */ |
| 10 | |
| 11 | #include <linux/module.h> |
| 12 | #include <linux/kernel.h> |
| 13 | #include <linux/init.h> |
| 14 | #include <linux/err.h> |
| 15 | #include <linux/input.h> |
| 16 | #include <linux/interrupt.h> |
| 17 | #include <linux/workqueue.h> |
| 18 | #include <linux/spi/spi.h> |
| 19 | |
| 20 | #include "lis3lv02d.h" |
| 21 | |
| 22 | #define DRV_NAME "lis3lv02d_spi" |
| 23 | #define LIS3_SPI_READ 0x80 |
| 24 | |
| 25 | static int lis3_spi_read(struct lis3lv02d *lis3, int reg, u8 *v) |
| 26 | { |
| 27 | struct spi_device *spi = lis3->bus_priv; |
| 28 | int ret = spi_w8r8(spi, reg | LIS3_SPI_READ); |
| 29 | if (ret < 0) |
| 30 | return -EINVAL; |
| 31 | |
| 32 | *v = (u8) ret; |
| 33 | return 0; |
| 34 | } |
| 35 | |
| 36 | static int lis3_spi_write(struct lis3lv02d *lis3, int reg, u8 val) |
| 37 | { |
| 38 | u8 tmp[2] = { reg, val }; |
| 39 | struct spi_device *spi = lis3->bus_priv; |
| 40 | return spi_write(spi, tmp, sizeof(tmp)); |
| 41 | } |
| 42 | |
| 43 | static int lis3_spi_init(struct lis3lv02d *lis3) |
| 44 | { |
| 45 | u8 reg; |
| 46 | int ret; |
| 47 | |
| 48 | /* power up the device */ |
| 49 | ret = lis3->read(lis3, CTRL_REG1, ®); |
| 50 | if (ret < 0) |
| 51 | return ret; |
| 52 | |
| 53 | reg |= CTRL1_PD0; |
| 54 | return lis3->write(lis3, CTRL_REG1, reg); |
| 55 | } |
| 56 | |
| 57 | static struct axis_conversion lis3lv02d_axis_normal = { 1, 2, 3 }; |
| 58 | |
| 59 | static int __devinit lis302dl_spi_probe(struct spi_device *spi) |
| 60 | { |
| 61 | int ret; |
| 62 | |
| 63 | spi->bits_per_word = 8; |
| 64 | spi->mode = SPI_MODE_0; |
| 65 | ret = spi_setup(spi); |
| 66 | if (ret < 0) |
| 67 | return ret; |
| 68 | |
Daniel Mack | dc791f8 | 2009-09-21 17:04:45 -0700 | [diff] [blame] | 69 | lis3_dev.bus_priv = spi; |
| 70 | lis3_dev.init = lis3_spi_init; |
| 71 | lis3_dev.read = lis3_spi_read; |
| 72 | lis3_dev.write = lis3_spi_write; |
| 73 | lis3_dev.irq = spi->irq; |
| 74 | lis3_dev.ac = lis3lv02d_axis_normal; |
| 75 | lis3_dev.pdata = spi->dev.platform_data; |
Daniel Mack | bb233fd | 2009-03-31 15:24:33 -0700 | [diff] [blame] | 76 | spi_set_drvdata(spi, &lis3_dev); |
| 77 | |
Daniel Mack | dc791f8 | 2009-09-21 17:04:45 -0700 | [diff] [blame] | 78 | return lis3lv02d_init_device(&lis3_dev); |
Daniel Mack | bb233fd | 2009-03-31 15:24:33 -0700 | [diff] [blame] | 79 | } |
| 80 | |
| 81 | static int __devexit lis302dl_spi_remove(struct spi_device *spi) |
| 82 | { |
| 83 | struct lis3lv02d *lis3 = spi_get_drvdata(spi); |
| 84 | lis3lv02d_joystick_disable(); |
| 85 | lis3lv02d_poweroff(lis3); |
| 86 | return 0; |
| 87 | } |
| 88 | |
Daniel Mack | 2cd9645 | 2009-09-21 17:04:44 -0700 | [diff] [blame] | 89 | #ifdef CONFIG_PM |
| 90 | static int lis3lv02d_spi_suspend(struct spi_device *spi, pm_message_t mesg) |
| 91 | { |
| 92 | struct lis3lv02d *lis3 = spi_get_drvdata(spi); |
| 93 | |
| 94 | if (!lis3->pdata->wakeup_flags) |
| 95 | lis3lv02d_poweroff(&lis3_dev); |
| 96 | |
| 97 | return 0; |
| 98 | } |
| 99 | |
| 100 | static int lis3lv02d_spi_resume(struct spi_device *spi) |
| 101 | { |
| 102 | struct lis3lv02d *lis3 = spi_get_drvdata(spi); |
| 103 | |
| 104 | if (!lis3->pdata->wakeup_flags) |
| 105 | lis3lv02d_poweron(lis3); |
| 106 | |
| 107 | return 0; |
| 108 | } |
| 109 | |
| 110 | #else |
| 111 | #define lis3lv02d_spi_suspend NULL |
| 112 | #define lis3lv02d_spi_resume NULL |
| 113 | #endif |
| 114 | |
Daniel Mack | bb233fd | 2009-03-31 15:24:33 -0700 | [diff] [blame] | 115 | static struct spi_driver lis302dl_spi_driver = { |
| 116 | .driver = { |
| 117 | .name = DRV_NAME, |
| 118 | .owner = THIS_MODULE, |
| 119 | }, |
| 120 | .probe = lis302dl_spi_probe, |
| 121 | .remove = __devexit_p(lis302dl_spi_remove), |
Daniel Mack | 2cd9645 | 2009-09-21 17:04:44 -0700 | [diff] [blame] | 122 | .suspend = lis3lv02d_spi_suspend, |
| 123 | .resume = lis3lv02d_spi_resume, |
Daniel Mack | bb233fd | 2009-03-31 15:24:33 -0700 | [diff] [blame] | 124 | }; |
| 125 | |
| 126 | static int __init lis302dl_init(void) |
| 127 | { |
| 128 | return spi_register_driver(&lis302dl_spi_driver); |
| 129 | } |
| 130 | |
| 131 | static void __exit lis302dl_exit(void) |
| 132 | { |
| 133 | spi_unregister_driver(&lis302dl_spi_driver); |
| 134 | } |
| 135 | |
| 136 | module_init(lis302dl_init); |
| 137 | module_exit(lis302dl_exit); |
| 138 | |
| 139 | MODULE_AUTHOR("Daniel Mack <daniel@caiaq.de>"); |
| 140 | MODULE_DESCRIPTION("lis3lv02d SPI glue layer"); |
| 141 | MODULE_LICENSE("GPL"); |
Anton Vorontsov | e0626e3 | 2009-09-22 16:46:08 -0700 | [diff] [blame^] | 142 | MODULE_ALIAS("spi:" DRV_NAME); |