1 /* 2 * Support code for the SCOOP interface found on various Sharp PDAs 3 * 4 * Copyright (c) 2004 Richard Purdie 5 * 6 * Based on code written by Sharp/Lineo for 2.4 kernels 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 */ 13 14 #include <linux/device.h> 15 #include <linux/string.h> 16 #include <linux/slab.h> 17 #include <linux/platform_device.h> 18 #include <asm/io.h> 19 #include <asm/hardware/scoop.h> 20 21 #define SCOOP_REG(d,adr) (*(volatile unsigned short*)(d +(adr))) 22 23 struct scoop_dev { 24 void *base; 25 spinlock_t scoop_lock; 26 unsigned short suspend_clr; 27 unsigned short suspend_set; 28 u32 scoop_gpwr; 29 }; 30 31 void reset_scoop(struct device *dev) 32 { 33 struct scoop_dev *sdev = dev_get_drvdata(dev); 34 35 SCOOP_REG(sdev->base,SCOOP_MCR) = 0x0100; // 00 36 SCOOP_REG(sdev->base,SCOOP_CDR) = 0x0000; // 04 37 SCOOP_REG(sdev->base,SCOOP_CCR) = 0x0000; // 10 38 SCOOP_REG(sdev->base,SCOOP_IMR) = 0x0000; // 18 39 SCOOP_REG(sdev->base,SCOOP_IRM) = 0x00FF; // 14 40 SCOOP_REG(sdev->base,SCOOP_ISR) = 0x0000; // 1C 41 SCOOP_REG(sdev->base,SCOOP_IRM) = 0x0000; 42 } 43 44 unsigned short set_scoop_gpio(struct device *dev, unsigned short bit) 45 { 46 unsigned short gpio_bit; 47 unsigned long flag; 48 struct scoop_dev *sdev = dev_get_drvdata(dev); 49 50 spin_lock_irqsave(&sdev->scoop_lock, flag); 51 gpio_bit = SCOOP_REG(sdev->base, SCOOP_GPWR) | bit; 52 SCOOP_REG(sdev->base, SCOOP_GPWR) = gpio_bit; 53 spin_unlock_irqrestore(&sdev->scoop_lock, flag); 54 55 return gpio_bit; 56 } 57 58 unsigned short reset_scoop_gpio(struct device *dev, unsigned short bit) 59 { 60 unsigned short gpio_bit; 61 unsigned long flag; 62 struct scoop_dev *sdev = dev_get_drvdata(dev); 63 64 spin_lock_irqsave(&sdev->scoop_lock, flag); 65 gpio_bit = SCOOP_REG(sdev->base, SCOOP_GPWR) & ~bit; 66 SCOOP_REG(sdev->base,SCOOP_GPWR) = gpio_bit; 67 spin_unlock_irqrestore(&sdev->scoop_lock, flag); 68 69 return gpio_bit; 70 } 71 72 EXPORT_SYMBOL(set_scoop_gpio); 73 EXPORT_SYMBOL(reset_scoop_gpio); 74 75 unsigned short read_scoop_reg(struct device *dev, unsigned short reg) 76 { 77 struct scoop_dev *sdev = dev_get_drvdata(dev); 78 return SCOOP_REG(sdev->base,reg); 79 } 80 81 void write_scoop_reg(struct device *dev, unsigned short reg, unsigned short data) 82 { 83 struct scoop_dev *sdev = dev_get_drvdata(dev); 84 SCOOP_REG(sdev->base,reg)=data; 85 } 86 87 EXPORT_SYMBOL(reset_scoop); 88 EXPORT_SYMBOL(read_scoop_reg); 89 EXPORT_SYMBOL(write_scoop_reg); 90 91 static void check_scoop_reg(struct scoop_dev *sdev) 92 { 93 unsigned short mcr; 94 95 mcr = SCOOP_REG(sdev->base, SCOOP_MCR); 96 if ((mcr & 0x100) == 0) 97 SCOOP_REG(sdev->base, SCOOP_MCR) = 0x0101; 98 } 99 100 #ifdef CONFIG_PM 101 static int scoop_suspend(struct platform_device *dev, pm_message_t state) 102 { 103 struct scoop_dev *sdev = platform_get_drvdata(dev); 104 105 check_scoop_reg(sdev); 106 sdev->scoop_gpwr = SCOOP_REG(sdev->base, SCOOP_GPWR); 107 SCOOP_REG(sdev->base, SCOOP_GPWR) = (sdev->scoop_gpwr & ~sdev->suspend_clr) | sdev->suspend_set; 108 109 return 0; 110 } 111 112 static int scoop_resume(struct platform_device *dev) 113 { 114 struct scoop_dev *sdev = platform_get_drvdata(dev); 115 116 check_scoop_reg(sdev); 117 SCOOP_REG(sdev->base,SCOOP_GPWR) = sdev->scoop_gpwr; 118 119 return 0; 120 } 121 #else 122 #define scoop_suspend NULL 123 #define scoop_resume NULL 124 #endif 125 126 int __init scoop_probe(struct platform_device *pdev) 127 { 128 struct scoop_dev *devptr; 129 struct scoop_config *inf; 130 struct resource *mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); 131 132 if (!mem) 133 return -EINVAL; 134 135 devptr = kzalloc(sizeof(struct scoop_dev), GFP_KERNEL); 136 if (!devptr) 137 return -ENOMEM; 138 139 spin_lock_init(&devptr->scoop_lock); 140 141 inf = pdev->dev.platform_data; 142 devptr->base = ioremap(mem->start, mem->end - mem->start + 1); 143 144 if (!devptr->base) { 145 kfree(devptr); 146 return -ENOMEM; 147 } 148 149 platform_set_drvdata(pdev, devptr); 150 151 printk("Sharp Scoop Device found at 0x%08x -> 0x%08x\n",(unsigned int)mem->start,(unsigned int)devptr->base); 152 153 SCOOP_REG(devptr->base, SCOOP_MCR) = 0x0140; 154 reset_scoop(&pdev->dev); 155 SCOOP_REG(devptr->base, SCOOP_CPR) = 0x0000; 156 SCOOP_REG(devptr->base, SCOOP_GPCR) = inf->io_dir & 0xffff; 157 SCOOP_REG(devptr->base, SCOOP_GPWR) = inf->io_out & 0xffff; 158 159 devptr->suspend_clr = inf->suspend_clr; 160 devptr->suspend_set = inf->suspend_set; 161 162 return 0; 163 } 164 165 static int scoop_remove(struct platform_device *pdev) 166 { 167 struct scoop_dev *sdev = platform_get_drvdata(pdev); 168 if (sdev) { 169 iounmap(sdev->base); 170 kfree(sdev); 171 platform_set_drvdata(pdev, NULL); 172 } 173 return 0; 174 } 175 176 static struct platform_driver scoop_driver = { 177 .probe = scoop_probe, 178 .remove = scoop_remove, 179 .suspend = scoop_suspend, 180 .resume = scoop_resume, 181 .driver = { 182 .name = "sharp-scoop", 183 }, 184 }; 185 186 int __init scoop_init(void) 187 { 188 return platform_driver_register(&scoop_driver); 189 } 190 191 subsys_initcall(scoop_init); 192