3 * Toshiba T7L66XB core mfd support
5 * Copyright (c) 2005, 2007, 2008 Ian Molton
6 * Copyright (c) 2008 Dmitry Baryshkov
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.
14 * Supported in this driver:
16 * SM/NAND flash controller
18 * As yet not supported
19 * GPIO interface (on NAND pins)
21 * TFT 'interface converter'
22 * PCMCIA interface logic
25 #include <linux/kernel.h>
26 #include <linux/module.h>
27 #include <linux/err.h>
29 #include <linux/slab.h>
30 #include <linux/irq.h>
31 #include <linux/clk.h>
32 #include <linux/platform_device.h>
33 #include <linux/mfd/core.h>
34 #include <linux/mfd/tmio.h>
35 #include <linux/mfd/t7l66xb.h>
42 static const struct resource t7l66xb_mmc_resources
[] = {
46 .flags
= IORESOURCE_MEM
,
49 .start
= IRQ_T7L66XB_MMC
,
50 .end
= IRQ_T7L66XB_MMC
,
51 .flags
= IORESOURCE_IRQ
,
55 #define SCR_REVID 0x08 /* b Revision ID */
56 #define SCR_IMR 0x42 /* b Interrupt Mask */
57 #define SCR_DEV_CTL 0xe0 /* b Device control */
58 #define SCR_ISR 0xe1 /* b Interrupt Status */
59 #define SCR_GPO_OC 0xf0 /* b GPO output control */
60 #define SCR_GPO_OS 0xf1 /* b GPO output enable */
61 #define SCR_GPI_S 0xf2 /* w GPI status */
62 #define SCR_APDC 0xf8 /* b Active pullup down ctrl */
64 #define SCR_DEV_CTL_USB BIT(0) /* USB enable */
65 #define SCR_DEV_CTL_MMC BIT(1) /* MMC enable */
67 /*--------------------------------------------------------------------------*/
71 /* Lock to protect registers requiring read/modify/write ops. */
81 /*--------------------------------------------------------------------------*/
83 static int t7l66xb_mmc_enable(struct platform_device
*mmc
)
85 struct platform_device
*dev
= to_platform_device(mmc
->dev
.parent
);
86 struct t7l66xb
*t7l66xb
= platform_get_drvdata(dev
);
90 clk_prepare_enable(t7l66xb
->clk32k
);
92 raw_spin_lock_irqsave(&t7l66xb
->lock
, flags
);
94 dev_ctl
= tmio_ioread8(t7l66xb
->scr
+ SCR_DEV_CTL
);
95 dev_ctl
|= SCR_DEV_CTL_MMC
;
96 tmio_iowrite8(dev_ctl
, t7l66xb
->scr
+ SCR_DEV_CTL
);
98 raw_spin_unlock_irqrestore(&t7l66xb
->lock
, flags
);
100 tmio_core_mmc_enable(t7l66xb
->scr
+ 0x200, 0,
101 t7l66xb_mmc_resources
[0].start
& 0xfffe);
106 static int t7l66xb_mmc_disable(struct platform_device
*mmc
)
108 struct platform_device
*dev
= to_platform_device(mmc
->dev
.parent
);
109 struct t7l66xb
*t7l66xb
= platform_get_drvdata(dev
);
113 raw_spin_lock_irqsave(&t7l66xb
->lock
, flags
);
115 dev_ctl
= tmio_ioread8(t7l66xb
->scr
+ SCR_DEV_CTL
);
116 dev_ctl
&= ~SCR_DEV_CTL_MMC
;
117 tmio_iowrite8(dev_ctl
, t7l66xb
->scr
+ SCR_DEV_CTL
);
119 raw_spin_unlock_irqrestore(&t7l66xb
->lock
, flags
);
121 clk_disable_unprepare(t7l66xb
->clk32k
);
126 static void t7l66xb_mmc_pwr(struct platform_device
*mmc
, int state
)
128 struct platform_device
*dev
= to_platform_device(mmc
->dev
.parent
);
129 struct t7l66xb
*t7l66xb
= platform_get_drvdata(dev
);
131 tmio_core_mmc_pwr(t7l66xb
->scr
+ 0x200, 0, state
);
134 static void t7l66xb_mmc_clk_div(struct platform_device
*mmc
, int state
)
136 struct platform_device
*dev
= to_platform_device(mmc
->dev
.parent
);
137 struct t7l66xb
*t7l66xb
= platform_get_drvdata(dev
);
139 tmio_core_mmc_clk_div(t7l66xb
->scr
+ 0x200, 0, state
);
142 /*--------------------------------------------------------------------------*/
144 static struct tmio_mmc_data t7166xb_mmc_data
= {
146 .set_pwr
= t7l66xb_mmc_pwr
,
147 .set_clk_div
= t7l66xb_mmc_clk_div
,
150 static const struct resource t7l66xb_nand_resources
[] = {
154 .flags
= IORESOURCE_MEM
,
159 .flags
= IORESOURCE_MEM
,
162 .start
= IRQ_T7L66XB_NAND
,
163 .end
= IRQ_T7L66XB_NAND
,
164 .flags
= IORESOURCE_IRQ
,
168 static struct mfd_cell t7l66xb_cells
[] = {
169 [T7L66XB_CELL_MMC
] = {
171 .enable
= t7l66xb_mmc_enable
,
172 .disable
= t7l66xb_mmc_disable
,
173 .platform_data
= &t7166xb_mmc_data
,
174 .pdata_size
= sizeof(t7166xb_mmc_data
),
175 .num_resources
= ARRAY_SIZE(t7l66xb_mmc_resources
),
176 .resources
= t7l66xb_mmc_resources
,
178 [T7L66XB_CELL_NAND
] = {
180 .num_resources
= ARRAY_SIZE(t7l66xb_nand_resources
),
181 .resources
= t7l66xb_nand_resources
,
185 /*--------------------------------------------------------------------------*/
187 /* Handle the T7L66XB interrupt mux */
188 static void t7l66xb_irq(struct irq_desc
*desc
)
190 struct t7l66xb
*t7l66xb
= irq_desc_get_handler_data(desc
);
192 unsigned int i
, irq_base
;
194 irq_base
= t7l66xb
->irq_base
;
196 while ((isr
= tmio_ioread8(t7l66xb
->scr
+ SCR_ISR
) &
197 ~tmio_ioread8(t7l66xb
->scr
+ SCR_IMR
)))
198 for (i
= 0; i
< T7L66XB_NR_IRQS
; i
++)
200 generic_handle_irq(irq_base
+ i
);
203 static void t7l66xb_irq_mask(struct irq_data
*data
)
205 struct t7l66xb
*t7l66xb
= irq_data_get_irq_chip_data(data
);
209 raw_spin_lock_irqsave(&t7l66xb
->lock
, flags
);
210 imr
= tmio_ioread8(t7l66xb
->scr
+ SCR_IMR
);
211 imr
|= 1 << (data
->irq
- t7l66xb
->irq_base
);
212 tmio_iowrite8(imr
, t7l66xb
->scr
+ SCR_IMR
);
213 raw_spin_unlock_irqrestore(&t7l66xb
->lock
, flags
);
216 static void t7l66xb_irq_unmask(struct irq_data
*data
)
218 struct t7l66xb
*t7l66xb
= irq_data_get_irq_chip_data(data
);
222 raw_spin_lock_irqsave(&t7l66xb
->lock
, flags
);
223 imr
= tmio_ioread8(t7l66xb
->scr
+ SCR_IMR
);
224 imr
&= ~(1 << (data
->irq
- t7l66xb
->irq_base
));
225 tmio_iowrite8(imr
, t7l66xb
->scr
+ SCR_IMR
);
226 raw_spin_unlock_irqrestore(&t7l66xb
->lock
, flags
);
229 static struct irq_chip t7l66xb_chip
= {
231 .irq_ack
= t7l66xb_irq_mask
,
232 .irq_mask
= t7l66xb_irq_mask
,
233 .irq_unmask
= t7l66xb_irq_unmask
,
236 /*--------------------------------------------------------------------------*/
238 /* Install the IRQ handler */
239 static void t7l66xb_attach_irq(struct platform_device
*dev
)
241 struct t7l66xb
*t7l66xb
= platform_get_drvdata(dev
);
242 unsigned int irq
, irq_base
;
244 irq_base
= t7l66xb
->irq_base
;
246 for (irq
= irq_base
; irq
< irq_base
+ T7L66XB_NR_IRQS
; irq
++) {
247 irq_set_chip_and_handler(irq
, &t7l66xb_chip
, handle_level_irq
);
248 irq_set_chip_data(irq
, t7l66xb
);
251 irq_set_irq_type(t7l66xb
->irq
, IRQ_TYPE_EDGE_FALLING
);
252 irq_set_chained_handler_and_data(t7l66xb
->irq
, t7l66xb_irq
, t7l66xb
);
255 static void t7l66xb_detach_irq(struct platform_device
*dev
)
257 struct t7l66xb
*t7l66xb
= platform_get_drvdata(dev
);
258 unsigned int irq
, irq_base
;
260 irq_base
= t7l66xb
->irq_base
;
262 irq_set_chained_handler_and_data(t7l66xb
->irq
, NULL
, NULL
);
264 for (irq
= irq_base
; irq
< irq_base
+ T7L66XB_NR_IRQS
; irq
++) {
265 irq_set_chip(irq
, NULL
);
266 irq_set_chip_data(irq
, NULL
);
270 /*--------------------------------------------------------------------------*/
273 static int t7l66xb_suspend(struct platform_device
*dev
, pm_message_t state
)
275 struct t7l66xb
*t7l66xb
= platform_get_drvdata(dev
);
276 struct t7l66xb_platform_data
*pdata
= dev_get_platdata(&dev
->dev
);
278 if (pdata
&& pdata
->suspend
)
280 clk_disable_unprepare(t7l66xb
->clk48m
);
285 static int t7l66xb_resume(struct platform_device
*dev
)
287 struct t7l66xb
*t7l66xb
= platform_get_drvdata(dev
);
288 struct t7l66xb_platform_data
*pdata
= dev_get_platdata(&dev
->dev
);
290 clk_prepare_enable(t7l66xb
->clk48m
);
291 if (pdata
&& pdata
->resume
)
294 tmio_core_mmc_enable(t7l66xb
->scr
+ 0x200, 0,
295 t7l66xb_mmc_resources
[0].start
& 0xfffe);
300 #define t7l66xb_suspend NULL
301 #define t7l66xb_resume NULL
304 /*--------------------------------------------------------------------------*/
306 static int t7l66xb_probe(struct platform_device
*dev
)
308 struct t7l66xb_platform_data
*pdata
= dev_get_platdata(&dev
->dev
);
309 struct t7l66xb
*t7l66xb
;
310 struct resource
*iomem
, *rscr
;
316 iomem
= platform_get_resource(dev
, IORESOURCE_MEM
, 0);
320 t7l66xb
= kzalloc(sizeof *t7l66xb
, GFP_KERNEL
);
324 raw_spin_lock_init(&t7l66xb
->lock
);
326 platform_set_drvdata(dev
, t7l66xb
);
328 ret
= platform_get_irq(dev
, 0);
334 t7l66xb
->irq_base
= pdata
->irq_base
;
336 t7l66xb
->clk32k
= clk_get(&dev
->dev
, "CLK_CK32K");
337 if (IS_ERR(t7l66xb
->clk32k
)) {
338 ret
= PTR_ERR(t7l66xb
->clk32k
);
342 t7l66xb
->clk48m
= clk_get(&dev
->dev
, "CLK_CK48M");
343 if (IS_ERR(t7l66xb
->clk48m
)) {
344 ret
= PTR_ERR(t7l66xb
->clk48m
);
348 rscr
= &t7l66xb
->rscr
;
349 rscr
->name
= "t7l66xb-core";
350 rscr
->start
= iomem
->start
;
351 rscr
->end
= iomem
->start
+ 0xff;
352 rscr
->flags
= IORESOURCE_MEM
;
354 ret
= request_resource(iomem
, rscr
);
356 goto err_request_scr
;
358 t7l66xb
->scr
= ioremap(rscr
->start
, resource_size(rscr
));
364 clk_prepare_enable(t7l66xb
->clk48m
);
369 /* Mask all interrupts */
370 tmio_iowrite8(0xbf, t7l66xb
->scr
+ SCR_IMR
);
372 printk(KERN_INFO
"%s rev %d @ 0x%08lx, irq %d\n",
373 dev
->name
, tmio_ioread8(t7l66xb
->scr
+ SCR_REVID
),
374 (unsigned long)iomem
->start
, t7l66xb
->irq
);
376 t7l66xb_attach_irq(dev
);
378 t7l66xb_cells
[T7L66XB_CELL_NAND
].platform_data
= pdata
->nand_data
;
379 t7l66xb_cells
[T7L66XB_CELL_NAND
].pdata_size
= sizeof(*pdata
->nand_data
);
381 ret
= mfd_add_devices(&dev
->dev
, dev
->id
,
382 t7l66xb_cells
, ARRAY_SIZE(t7l66xb_cells
),
383 iomem
, t7l66xb
->irq_base
, NULL
);
388 t7l66xb_detach_irq(dev
);
389 iounmap(t7l66xb
->scr
);
391 release_resource(&t7l66xb
->rscr
);
393 clk_put(t7l66xb
->clk48m
);
395 clk_put(t7l66xb
->clk32k
);
402 static int t7l66xb_remove(struct platform_device
*dev
)
404 struct t7l66xb_platform_data
*pdata
= dev_get_platdata(&dev
->dev
);
405 struct t7l66xb
*t7l66xb
= platform_get_drvdata(dev
);
408 ret
= pdata
->disable(dev
);
409 clk_disable_unprepare(t7l66xb
->clk48m
);
410 clk_put(t7l66xb
->clk48m
);
411 clk_disable_unprepare(t7l66xb
->clk32k
);
412 clk_put(t7l66xb
->clk32k
);
413 t7l66xb_detach_irq(dev
);
414 iounmap(t7l66xb
->scr
);
415 release_resource(&t7l66xb
->rscr
);
416 mfd_remove_devices(&dev
->dev
);
423 static struct platform_driver t7l66xb_platform_driver
= {
427 .suspend
= t7l66xb_suspend
,
428 .resume
= t7l66xb_resume
,
429 .probe
= t7l66xb_probe
,
430 .remove
= t7l66xb_remove
,
433 /*--------------------------------------------------------------------------*/
435 module_platform_driver(t7l66xb_platform_driver
);
437 MODULE_DESCRIPTION("Toshiba T7L66XB core driver");
438 MODULE_LICENSE("GPL v2");
439 MODULE_AUTHOR("Ian Molton");
440 MODULE_ALIAS("platform:t7l66xb");