SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/spi/tle62x0.c

   1 /*
   2  * tle62x0.c -- support Infineon TLE62x0 driver chips
   3  *
   4  * Copyright (c) 2007 Simtec Electronics
   5  *      Ben Dooks, <ben@simtec.co.uk>
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License version 2 as
   9  * published by the Free Software Foundation.
  10  */
  11
  12 #include <linux/device.h>
  13 #include <linux/kernel.h>
  14
  15 #include <linux/spi/spi.h>
  16 #include <linux/spi/tle62x0.h>
  17
  18
  19 #define CMD_READ        0x00
  20 #define CMD_SET         0xff
  21
  22 #define DIAG_NORMAL     0x03
  23 #define DIAG_OVERLOAD   0x02
  24 #define DIAG_OPEN       0x01
  25 #define DIAG_SHORTGND   0x00
  26
  27 struct tle62x0_state {
  28         struct spi_device       *us;
  29         struct mutex            lock;
  30         unsigned int            nr_gpio;
  31         unsigned int            gpio_state;
  32
  33         unsigned char           tx_buff[4];
  34         unsigned char           rx_buff[4];
  35 };
  36
  37 static int to_gpio_num(struct device_attribute *attr);
  38
  39 static inline int tle62x0_write(struct tle62x0_state *st)
  40 {
  41         unsigned char *buff = st->tx_buff;
  42         unsigned int gpio_state = st->gpio_state;
  43
  44         buff[0] = CMD_SET;
  45
  46         if (st->nr_gpio == 16) {
  47                 buff[1] = gpio_state >> 8;
  48                 buff[2] = gpio_state;
  49         } else {
  50                 buff[1] = gpio_state;
  51         }
  52
  53         dev_dbg(&st->us->dev, "buff %02x,%02x,%02x\n",
  54                 buff[0], buff[1], buff[2]);
  55
  56         return spi_write(st->us, buff, (st->nr_gpio == 16) ? 3 : 2);
  57 }
  58
  59 static inline int tle62x0_read(struct tle62x0_state *st)
  60 {
  61         unsigned char *txbuff = st->tx_buff;
  62         struct spi_transfer xfer = {
  63                 .tx_buf         = txbuff,
  64                 .rx_buf         = st->rx_buff,
  65                 .len            = (st->nr_gpio * 2) / 8,
  66         };
  67         struct spi_message msg;
  68
  69         txbuff[0] = CMD_READ;
  70         txbuff[1] = 0x00;
  71         txbuff[2] = 0x00;
  72         txbuff[3] = 0x00;
  73
  74         spi_message_init(&msg);
  75         spi_message_add_tail(&xfer, &msg);
  76
  77         return spi_sync(st->us, &msg);
  78 }
  79
  80 static unsigned char *decode_fault(unsigned int fault_code)
  81 {
  82         fault_code &= 3;
  83
  84         switch (fault_code) {
  85         case DIAG_NORMAL:
  86                 return "N";
  87         case DIAG_OVERLOAD:
  88                 return "V";
  89         case DIAG_OPEN:
  90                 return "O";
  91         case DIAG_SHORTGND:
  92                 return "G";
  93         }
  94
  95         return "?";
  96 }
  97
  98 static ssize_t tle62x0_status_show(struct device *dev,
  99                 struct device_attribute *attr, char *buf)
 100 {
 101         struct tle62x0_state *st = dev_get_drvdata(dev);
 102         char *bp = buf;
 103         unsigned char *buff = st->rx_buff;
 104         unsigned long fault = 0;
 105         int ptr;
 106         int ret;
 107
 108         mutex_lock(&st->lock);
 109         ret = tle62x0_read(st);
 110         dev_dbg(dev, "tle62x0_read() returned %d\n", ret);
 111         if (ret < 0) {
 112                 mutex_unlock(&st->lock);
 113                 return ret;
 114         }
 115
 116         for (ptr = 0; ptr < (st->nr_gpio * 2)/8; ptr += 1) {
 117                 fault <<= 8;
 118                 fault  |= ((unsigned long)buff[ptr]);
 119
 120                 dev_dbg(dev, "byte %d is %02x\n", ptr, buff[ptr]);
 121         }
 122
 123         for (ptr = 0; ptr < st->nr_gpio; ptr++) {
 124                 bp += sprintf(bp, "%s ", decode_fault(fault >> (ptr * 2)));
 125         }
 126
 127         *bp++ = '\n';
 128
 129         mutex_unlock(&st->lock);
 130         return bp - buf;
 131 }
 132
 133 static DEVICE_ATTR(status_show, S_IRUGO, tle62x0_status_show, NULL);
 134
 135 static ssize_t tle62x0_gpio_show(struct device *dev,
 136                 struct device_attribute *attr, char *buf)
 137 {
 138         struct tle62x0_state *st = dev_get_drvdata(dev);
 139         int gpio_num = to_gpio_num(attr);
 140         int value;
 141
 142         mutex_lock(&st->lock);
 143         value = (st->gpio_state >> gpio_num) & 1;
 144         mutex_unlock(&st->lock);
 145
 146         return snprintf(buf, PAGE_SIZE, "%d", value);
 147 }
 148
 149 static ssize_t tle62x0_gpio_store(struct device *dev,
 150                 struct device_attribute *attr,
 151                 const char *buf, size_t len)
 152 {
 153         struct tle62x0_state *st = dev_get_drvdata(dev);
 154         int gpio_num = to_gpio_num(attr);
 155         unsigned long val;
 156         char *endp;
 157
 158         val = simple_strtoul(buf, &endp, 0);
 159         if (buf == endp)
 160                 return -EINVAL;
 161
 162         dev_dbg(dev, "setting gpio %d to %ld\n", gpio_num, val);
 163
 164         mutex_lock(&st->lock);
 165
 166         if (val)
 167                 st->gpio_state |= 1 << gpio_num;
 168         else
 169                 st->gpio_state &= ~(1 << gpio_num);
 170
 171         tle62x0_write(st);
 172         mutex_unlock(&st->lock);
 173
 174         return len;
 175 }
 176
 177 static DEVICE_ATTR(gpio1, S_IWUSR|S_IRUGO,
 178                 tle62x0_gpio_show, tle62x0_gpio_store);
 179 static DEVICE_ATTR(gpio2, S_IWUSR|S_IRUGO,
 180                 tle62x0_gpio_show, tle62x0_gpio_store);
 181 static DEVICE_ATTR(gpio3, S_IWUSR|S_IRUGO,
 182                 tle62x0_gpio_show, tle62x0_gpio_store);
 183 static DEVICE_ATTR(gpio4, S_IWUSR|S_IRUGO,
 184                 tle62x0_gpio_show, tle62x0_gpio_store);
 185 static DEVICE_ATTR(gpio5, S_IWUSR|S_IRUGO,
 186                 tle62x0_gpio_show, tle62x0_gpio_store);
 187 static DEVICE_ATTR(gpio6, S_IWUSR|S_IRUGO,
 188                 tle62x0_gpio_show, tle62x0_gpio_store);
 189 static DEVICE_ATTR(gpio7, S_IWUSR|S_IRUGO,
 190                 tle62x0_gpio_show, tle62x0_gpio_store);
 191 static DEVICE_ATTR(gpio8, S_IWUSR|S_IRUGO,
 192                 tle62x0_gpio_show, tle62x0_gpio_store);
 193 static DEVICE_ATTR(gpio9, S_IWUSR|S_IRUGO,
 194                 tle62x0_gpio_show, tle62x0_gpio_store);
 195 static DEVICE_ATTR(gpio10, S_IWUSR|S_IRUGO,
 196                 tle62x0_gpio_show, tle62x0_gpio_store);
 197 static DEVICE_ATTR(gpio11, S_IWUSR|S_IRUGO,
 198                 tle62x0_gpio_show, tle62x0_gpio_store);
 199 static DEVICE_ATTR(gpio12, S_IWUSR|S_IRUGO,
 200                 tle62x0_gpio_show, tle62x0_gpio_store);
 201 static DEVICE_ATTR(gpio13, S_IWUSR|S_IRUGO,
 202                 tle62x0_gpio_show, tle62x0_gpio_store);
 203 static DEVICE_ATTR(gpio14, S_IWUSR|S_IRUGO,
 204                 tle62x0_gpio_show, tle62x0_gpio_store);
 205 static DEVICE_ATTR(gpio15, S_IWUSR|S_IRUGO,
 206                 tle62x0_gpio_show, tle62x0_gpio_store);
 207 static DEVICE_ATTR(gpio16, S_IWUSR|S_IRUGO,
 208                 tle62x0_gpio_show, tle62x0_gpio_store);
 209
 210 static struct device_attribute *gpio_attrs[] = {
 211         [0]             = &dev_attr_gpio1,
 212         [1]             = &dev_attr_gpio2,
 213         [2]             = &dev_attr_gpio3,
 214         [3]             = &dev_attr_gpio4,
 215         [4]             = &dev_attr_gpio5,
 216         [5]             = &dev_attr_gpio6,
 217         [6]             = &dev_attr_gpio7,
 218         [7]             = &dev_attr_gpio8,
 219         [8]             = &dev_attr_gpio9,
 220         [9]             = &dev_attr_gpio10,
 221         [10]            = &dev_attr_gpio11,
 222         [11]            = &dev_attr_gpio12,
 223         [12]            = &dev_attr_gpio13,
 224         [13]            = &dev_attr_gpio14,
 225         [14]            = &dev_attr_gpio15,
 226         [15]            = &dev_attr_gpio16
 227 };
 228
 229 static int to_gpio_num(struct device_attribute *attr)
 230 {
 231         int ptr;
 232
 233         for (ptr = 0; ptr < ARRAY_SIZE(gpio_attrs); ptr++) {
 234                 if (gpio_attrs[ptr] == attr)
 235                         return ptr;
 236         }
 237
 238         return -1;
 239 }
 240
 241 static int __devinit tle62x0_probe(struct spi_device *spi)
 242 {
 243         struct tle62x0_state *st;
 244         struct tle62x0_pdata *pdata;
 245         int ptr;
 246         int ret;
 247
 248         pdata = spi->dev.platform_data;
 249         if (pdata == NULL) {
 250                 dev_err(&spi->dev, "no device data specified\n");
 251                 return -EINVAL;
 252         }
 253
 254         st = kzalloc(sizeof(struct tle62x0_state), GFP_KERNEL);
 255         if (st == NULL) {
 256                 dev_err(&spi->dev, "no memory for device state\n");
 257                 return -ENOMEM;
 258         }
 259
 260         st->us = spi;
 261         st->nr_gpio = pdata->gpio_count;
 262         st->gpio_state = pdata->init_state;
 263
 264         mutex_init(&st->lock);
 265
 266         ret = device_create_file(&spi->dev, &dev_attr_status_show);
 267         if (ret) {
 268                 dev_err(&spi->dev, "cannot create status attribute\n");
 269                 goto err_status;
 270         }
 271
 272         for (ptr = 0; ptr < pdata->gpio_count; ptr++) {
 273                 ret = device_create_file(&spi->dev, gpio_attrs[ptr]);
 274                 if (ret) {
 275                         dev_err(&spi->dev, "cannot create gpio attribute\n");
 276                         goto err_gpios;
 277                 }
 278         }
 279
 280         /* tle62x0_write(st); */
 281         spi_set_drvdata(spi, st);
 282         return 0;
 283
 284  err_gpios:
 285         for (; ptr > 0; ptr--)
 286                 device_remove_file(&spi->dev, gpio_attrs[ptr]);
 287
 288         device_remove_file(&spi->dev, &dev_attr_status_show);
 289
 290  err_status:
 291         kfree(st);
 292         return ret;
 293 }
 294
 295 static int __devexit tle62x0_remove(struct spi_device *spi)
 296 {
 297         struct tle62x0_state *st = spi_get_drvdata(spi);
 298         int ptr;
 299
 300         for (ptr = 0; ptr < st->nr_gpio; ptr++)
 301                 device_remove_file(&spi->dev, gpio_attrs[ptr]);
 302
 303         kfree(st);
 304         return 0;
 305 }
 306
 307 static struct spi_driver tle62x0_driver = {
 308         .driver = {
 309                 .name   = "tle62x0",
 310                 .owner  = THIS_MODULE,
 311         },
 312         .probe          = tle62x0_probe,
 313         .remove         = __devexit_p(tle62x0_remove),
 314 };
 315
 316 static __init int tle62x0_init(void)
 317 {
 318         return spi_register_driver(&tle62x0_driver);
 319 }
 320
 321 static __exit void tle62x0_exit(void)
 322 {
 323         spi_unregister_driver(&tle62x0_driver);
 324 }
 325
 326 module_init(tle62x0_init);
 327 module_exit(tle62x0_exit);
 328
 329 MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
 330 MODULE_DESCRIPTION("TLE62x0 SPI driver");
 331 MODULE_LICENSE("GPL v2");
 332 MODULE_ALIAS("spi:tle62x0");