git.oblomov.eu Git - linux-2.6/blob - drivers/sbus/char/display7seg.c

   1 /* display7seg.c - Driver implementation for the 7-segment display
   2  *                 present on Sun Microsystems CP1400 and CP1500
   3  *
   4  * Copyright (c) 2000 Eric Brower (ebrower@usa.net)
   5  */
   6
   7 #include <linux/kernel.h>
   8 #include <linux/module.h>
   9 #include <linux/fs.h>
  10 #include <linux/errno.h>
  11 #include <linux/major.h>
  12 #include <linux/init.h>
  13 #include <linux/miscdevice.h>
  14 #include <linux/ioport.h>               /* request_region */
  15 #include <linux/smp_lock.h>
  16 #include <linux/of.h>
  17 #include <linux/of_device.h>
  18 #include <asm/atomic.h>
  19 #include <asm/uaccess.h>                /* put_/get_user                        */
  20 #include <asm/io.h>
  21
  22 #include <asm/display7seg.h>
  23
  24 #define D7S_MINOR       193
  25 #define DRIVER_NAME     "d7s"
  26 #define PFX             DRIVER_NAME ": "
  27
  28 static int sol_compat = 0;              /* Solaris compatibility mode   */
  29
  30 /* Solaris compatibility flag -
  31  * The Solaris implementation omits support for several
  32  * documented driver features (ref Sun doc 806-0180-03).
  33  * By default, this module supports the documented driver
  34  * abilities, rather than the Solaris implementation:
  35  *
  36  *      1) Device ALWAYS reverts to OBP-specified FLIPPED mode
  37  *         upon closure of device or module unload.
  38  *      2) Device ioctls D7SIOCRD/D7SIOCWR honor toggling of
  39  *         FLIP bit
  40  *
  41  * If you wish the device to operate as under Solaris,
  42  * omitting above features, set this parameter to non-zero.
  43  */
  44 module_param(sol_compat, int, 0);
  45 MODULE_PARM_DESC(sol_compat,
  46                  "Disables documented functionality omitted from Solaris driver");
  47
  48 MODULE_AUTHOR("Eric Brower <ebrower@usa.net>");
  49 MODULE_DESCRIPTION("7-Segment Display driver for Sun Microsystems CP1400/1500");
  50 MODULE_LICENSE("GPL");
  51 MODULE_SUPPORTED_DEVICE("d7s");
  52
  53 struct d7s {
  54         void __iomem    *regs;
  55         bool            flipped;
  56 };
  57 struct d7s *d7s_device;
  58
  59 /*
  60  * Register block address- see header for details
  61  * -----------------------------------------
  62  * | DP | ALARM | FLIP | 4 | 3 | 2 | 1 | 0 |
  63  * -----------------------------------------
  64  *
  65  * DP           - Toggles decimal point on/off
  66  * ALARM        - Toggles "Alarm" LED green/red
  67  * FLIP         - Inverts display for upside-down mounted board
  68  * bits 0-4     - 7-segment display contents
  69  */
  70 static atomic_t d7s_users = ATOMIC_INIT(0);
  71
  72 static int d7s_open(struct inode *inode, struct file *f)
  73 {
  74         if (D7S_MINOR != iminor(inode))
  75                 return -ENODEV;
  76         cycle_kernel_lock();
  77         atomic_inc(&d7s_users);
  78         return 0;
  79 }
  80
  81 static int d7s_release(struct inode *inode, struct file *f)
  82 {
  83         /* Reset flipped state to OBP default only if
  84          * no other users have the device open and we
  85          * are not operating in solaris-compat mode
  86          */
  87         if (atomic_dec_and_test(&d7s_users) && !sol_compat) {
  88                 struct d7s *p = d7s_device;
  89                 u8 regval = 0;
  90
  91                 regval = readb(p->regs);
  92                 if (p->flipped)
  93                         regval |= D7S_FLIP;
  94                 else
  95                         regval &= ~D7S_FLIP;
  96                 writeb(regval, p->regs);
  97         }
  98
  99         return 0;
 100 }
 101
 102 static long d7s_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
 103 {
 104         struct d7s *p = d7s_device;
 105         u8 regs = readb(p->regs);
 106         int error = 0;
 107         u8 ireg = 0;
 108
 109         if (D7S_MINOR != iminor(file->f_path.dentry->d_inode))
 110                 return -ENODEV;
 111
 112         lock_kernel();
 113         switch (cmd) {
 114         case D7SIOCWR:
 115                 /* assign device register values we mask-out D7S_FLIP
 116                  * if in sol_compat mode
 117                  */
 118                 if (get_user(ireg, (int __user *) arg)) {
 119                         error = -EFAULT;
 120                         break;
 121                 }
 122                 if (sol_compat) {
 123                         if (regs & D7S_FLIP)
 124                                 ireg |= D7S_FLIP;
 125                         else
 126                                 ireg &= ~D7S_FLIP;
 127                 }
 128                 writeb(ireg, p->regs);
 129                 break;
 130
 131         case D7SIOCRD:
 132                 /* retrieve device register values
 133                  * NOTE: Solaris implementation returns D7S_FLIP bit
 134                  * as toggled by user, even though it does not honor it.
 135                  * This driver will not misinform you about the state
 136                  * of your hardware while in sol_compat mode
 137                  */
 138                 if (put_user(regs, (int __user *) arg)) {
 139                         error = -EFAULT;
 140                         break;
 141                 }
 142                 break;
 143
 144         case D7SIOCTM:
 145                 /* toggle device mode-- flip display orientation */
 146                 if (regs & D7S_FLIP)
 147                         regs &= ~D7S_FLIP;
 148                 else
 149                         regs |= D7S_FLIP;
 150                 writeb(regs, p->regs);
 151                 break;
 152         };
 153         unlock_kernel();
 154
 155         return error;
 156 }
 157
 158 static const struct file_operations d7s_fops = {
 159         .owner =                THIS_MODULE,
 160         .unlocked_ioctl =       d7s_ioctl,
 161         .compat_ioctl =         d7s_ioctl,
 162         .open =                 d7s_open,
 163         .release =              d7s_release,
 164 };
 165
 166 static struct miscdevice d7s_miscdev = {
 167         .minor          = D7S_MINOR,
 168         .name           = DRIVER_NAME,
 169         .fops           = &d7s_fops
 170 };
 171
 172 static int __devinit d7s_probe(struct of_device *op,
 173                                const struct of_device_id *match)
 174 {
 175         struct device_node *opts;
 176         int err = -EINVAL;
 177         struct d7s *p;
 178         u8 regs;
 179
 180         if (d7s_device)
 181                 goto out;
 182
 183         p = kzalloc(sizeof(*p), GFP_KERNEL);
 184         err = -ENOMEM;
 185         if (!p)
 186                 goto out;
 187
 188         p->regs = of_ioremap(&op->resource[0], 0, sizeof(u8), "d7s");
 189         if (!p->regs) {
 190                 printk(KERN_ERR PFX "Cannot map chip registers\n");
 191                 goto out_free;
 192         }
 193
 194         err = misc_register(&d7s_miscdev);
 195         if (err) {
 196                 printk(KERN_ERR PFX "Unable to acquire miscdevice minor %i\n",
 197                        D7S_MINOR);
 198                 goto out_iounmap;
 199         }
 200
 201         /* OBP option "d7s-flipped?" is honored as default for the
 202          * device, and reset default when detached
 203          */
 204         regs = readb(p->regs);
 205         opts = of_find_node_by_path("/options");
 206         if (opts &&
 207             of_get_property(opts, "d7s-flipped?", NULL))
 208                 p->flipped = true;
 209
 210         if (p->flipped)
 211                 regs |= D7S_FLIP;
 212         else
 213                 regs &= ~D7S_FLIP;
 214
 215         writeb(regs,  p->regs);
 216
 217         printk(KERN_INFO PFX "7-Segment Display%s at [%s:0x%llx] %s\n",
 218                op->node->full_name,
 219                (regs & D7S_FLIP) ? " (FLIPPED)" : "",
 220                op->resource[0].start,
 221                sol_compat ? "in sol_compat mode" : "");
 222
 223         dev_set_drvdata(&op->dev, p);
 224         d7s_device = p;
 225         err = 0;
 226
 227 out:
 228         return err;
 229
 230 out_iounmap:
 231         of_iounmap(&op->resource[0], p->regs, sizeof(u8));
 232
 233 out_free:
 234         kfree(p);
 235         goto out;
 236 }
 237
 238 static int __devexit d7s_remove(struct of_device *op)
 239 {
 240         struct d7s *p = dev_get_drvdata(&op->dev);
 241         u8 regs = readb(p->regs);
 242
 243         /* Honor OBP d7s-flipped? unless operating in solaris-compat mode */
 244         if (sol_compat) {
 245                 if (p->flipped)
 246                         regs |= D7S_FLIP;
 247                 else
 248                         regs &= ~D7S_FLIP;
 249                 writeb(regs, p->regs);
 250         }
 251
 252         misc_deregister(&d7s_miscdev);
 253         of_iounmap(&op->resource[0], p->regs, sizeof(u8));
 254         kfree(p);
 255
 256         return 0;
 257 }
 258
 259 static const struct of_device_id d7s_match[] = {
 260         {
 261                 .name = "display7seg",
 262         },
 263         {},
 264 };
 265 MODULE_DEVICE_TABLE(of, d7s_match);
 266
 267 static struct of_platform_driver d7s_driver = {
 268         .name           = DRIVER_NAME,
 269         .match_table    = d7s_match,
 270         .probe          = d7s_probe,
 271         .remove         = __devexit_p(d7s_remove),
 272 };
 273
 274 static int __init d7s_init(void)
 275 {
 276         return of_register_driver(&d7s_driver, &of_bus_type);
 277 }
 278
 279 static void __exit d7s_exit(void)
 280 {
 281         of_unregister_driver(&d7s_driver);
 282 }
 283
 284 module_init(d7s_init);
 285 module_exit(d7s_exit);