1 /* linux/drivers/mfd/sm501.c
3 * Copyright (C) 2006 Simtec Electronics
4 * Ben Dooks <ben@simtec.co.uk>
5 * Vincent Sanders <vince@simtec.co.uk>
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.
14 #include <linux/kernel.h>
15 #include <linux/module.h>
16 #include <linux/delay.h>
17 #include <linux/init.h>
18 #include <linux/list.h>
19 #include <linux/device.h>
20 #include <linux/platform_device.h>
21 #include <linux/pci.h>
23 #include <linux/sm501.h>
24 #include <linux/sm501-regs.h>
29 struct list_head list
;
30 struct platform_device pdev
;
33 struct sm501_devdata
{
35 struct mutex clock_lock
;
36 struct list_head devices
;
39 struct resource
*io_res
;
40 struct resource
*mem_res
;
41 struct resource
*regs_claim
;
42 struct sm501_platdata
*platdata
;
44 unsigned int in_suspend
;
45 unsigned long pm_misc
;
51 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
54 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
57 #define MHZ (1000 * 1000)
60 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
61 static const unsigned int misc_div
[] = {
80 static const unsigned int px_div
[] = {
82 static const unsigned int div_tab
[] = {
83 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
110 static unsigned long decode_div(unsigned long pll2
, unsigned long val
,
111 unsigned int lshft
, unsigned int selbit
,
112 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
113 unsigned long mask
, const unsigned int *dtab
)
116 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
121 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
122 return pll2
/ dtab
[(val
>> lshft
) & mask
];
124 return pll2
/ div_tab
[(val
>> lshft
) & mask
];
125 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
128 #define fmt_freq(x) ((x) / MHZ), ((x) % MHZ), (x)
132 * Print out the current clock configuration for the device
135 static void sm501_dump_clk(struct sm501_devdata
*sm
)
137 unsigned long misct
= readl(sm
->regs
+ SM501_MISC_TIMING
);
138 unsigned long pm0
= readl(sm
->regs
+ SM501_POWER_MODE_0_CLOCK
);
139 unsigned long pm1
= readl(sm
->regs
+ SM501_POWER_MODE_1_CLOCK
);
140 unsigned long pmc
= readl(sm
->regs
+ SM501_POWER_MODE_CONTROL
);
141 unsigned long sdclk0
, sdclk1
;
142 unsigned long pll2
= 0;
144 switch (misct
& 0x30) {
159 sdclk0
= (misct
& (1<<12)) ? pll2
: 288 * MHZ
;
160 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
161 sdclk0
/= misc_div
[((misct
>> 8) & 0xf)];
163 sdclk0
/= div_tab
[((misct
>> 8) & 0xf)];
164 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
166 sdclk1
= (misct
& (1<<20)) ? pll2
: 288 * MHZ
;
167 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
168 sdclk1
/= misc_div
[((misct
>> 16) & 0xf)];
170 sdclk1
/= div_tab
[((misct
>> 16) & 0xf)];
171 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
173 dev_dbg(sm
->dev
, "MISCT=%08lx, PM0=%08lx, PM1=%08lx\n",
176 dev_dbg(sm
->dev
, "PLL2 = %ld.%ld MHz (%ld), SDCLK0=%08lx, SDCLK1=%08lx\n",
177 fmt_freq(pll2
), sdclk0
, sdclk1
);
179 dev_dbg(sm
->dev
, "SDRAM: PM0=%ld, PM1=%ld\n", sdclk0
, sdclk1
);
181 dev_dbg(sm
->dev
, "PM0[%c]: "
182 "P2 %ld.%ld MHz (%ld), V2 %ld.%ld (%ld), "
183 "M %ld.%ld (%ld), MX1 %ld.%ld (%ld)\n",
184 (pmc
& 3 ) == 0 ? '*' : '-',
185 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
186 fmt_freq(decode_div(pll2
, pm0
, 24, 1<<29, 31, px_div
)),
187 fmt_freq(decode_div(pll2
, pm0
, 16, 1<<20, 15, misc_div
)),
188 fmt_freq(decode_div(pll2
, pm0
, 8, 1<<12, 15, misc_div
)),
189 fmt_freq(decode_div(pll2
, pm0
, 0, 1<<4, 15, misc_div
)));
191 fmt_freq(decode_div(pll2
, pm0
, 24, 1<<29, 31)),
192 fmt_freq(decode_div(pll2
, pm0
, 16, 1<<20, 15)),
193 fmt_freq(decode_div(pll2
, pm0
, 8, 1<<12, 15)),
194 fmt_freq(decode_div(pll2
, pm0
, 0, 1<<4, 15)));
195 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
197 dev_dbg(sm
->dev
, "PM1[%c]: "
198 "P2 %ld.%ld MHz (%ld), V2 %ld.%ld (%ld), "
199 "M %ld.%ld (%ld), MX1 %ld.%ld (%ld)\n",
200 (pmc
& 3 ) == 1 ? '*' : '-',
201 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
202 fmt_freq(decode_div(pll2
, pm1
, 24, 1<<29, 31, px_div
)),
203 fmt_freq(decode_div(pll2
, pm1
, 16, 1<<20, 15, misc_div
)),
204 fmt_freq(decode_div(pll2
, pm1
, 8, 1<<12, 15, misc_div
)),
205 fmt_freq(decode_div(pll2
, pm1
, 0, 1<<4, 15, misc_div
)));
207 fmt_freq(decode_div(pll2
, pm1
, 24, 1<<29, 31)),
208 fmt_freq(decode_div(pll2
, pm1
, 16, 1<<20, 15)),
209 fmt_freq(decode_div(pll2
, pm1
, 8, 1<<12, 15)),
210 fmt_freq(decode_div(pll2
, pm1
, 0, 1<<4, 15)));
211 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
214 static void sm501_dump_regs(struct sm501_devdata
*sm
)
216 void __iomem
*regs
= sm
->regs
;
218 dev_info(sm
->dev
, "System Control %08x\n",
219 readl(regs
+ SM501_SYSTEM_CONTROL
));
220 dev_info(sm
->dev
, "Misc Control %08x\n",
221 readl(regs
+ SM501_MISC_CONTROL
));
222 dev_info(sm
->dev
, "GPIO Control Low %08x\n",
223 readl(regs
+ SM501_GPIO31_0_CONTROL
));
224 dev_info(sm
->dev
, "GPIO Control Hi %08x\n",
225 readl(regs
+ SM501_GPIO63_32_CONTROL
));
226 dev_info(sm
->dev
, "DRAM Control %08x\n",
227 readl(regs
+ SM501_DRAM_CONTROL
));
228 dev_info(sm
->dev
, "Arbitration Ctrl %08x\n",
229 readl(regs
+ SM501_ARBTRTN_CONTROL
));
230 dev_info(sm
->dev
, "Misc Timing %08x\n",
231 readl(regs
+ SM501_MISC_TIMING
));
234 static void sm501_dump_gate(struct sm501_devdata
*sm
)
236 dev_info(sm
->dev
, "CurrentGate %08x\n",
237 readl(sm
->regs
+ SM501_CURRENT_GATE
));
238 dev_info(sm
->dev
, "CurrentClock %08x\n",
239 readl(sm
->regs
+ SM501_CURRENT_CLOCK
));
240 dev_info(sm
->dev
, "PowerModeControl %08x\n",
241 readl(sm
->regs
+ SM501_POWER_MODE_CONTROL
));
245 static inline void sm501_dump_gate(struct sm501_devdata
*sm
) { }
246 static inline void sm501_dump_regs(struct sm501_devdata
*sm
) { }
247 static inline void sm501_dump_clk(struct sm501_devdata
*sm
) { }
255 static void sm501_sync_regs(struct sm501_devdata
*sm
)
260 static inline void sm501_mdelay(struct sm501_devdata
*sm
, unsigned int delay
)
262 /* during suspend/resume, we are currently not allowed to sleep,
263 * so change to using mdelay() instead of msleep() if we
264 * are in one of these paths */
272 /* sm501_misc_control
274 * alters the miscellaneous control parameters
277 int sm501_misc_control(struct device
*dev
,
278 unsigned long set
, unsigned long clear
)
280 struct sm501_devdata
*sm
= dev_get_drvdata(dev
);
285 spin_lock_irqsave(&sm
->reg_lock
, save
);
287 misc
= readl(sm
->regs
+ SM501_MISC_CONTROL
);
288 to
= (misc
& ~clear
) | set
;
291 writel(to
, sm
->regs
+ SM501_MISC_CONTROL
);
294 dev_dbg(sm
->dev
, "MISC_CONTROL %08lx\n", misc
);
297 spin_unlock_irqrestore(&sm
->reg_lock
, save
);
301 EXPORT_SYMBOL_GPL(sm501_misc_control
);
305 * Modify a register in the SM501 which may be shared with other
309 unsigned long sm501_modify_reg(struct device
*dev
,
314 struct sm501_devdata
*sm
= dev_get_drvdata(dev
);
318 spin_lock_irqsave(&sm
->reg_lock
, save
);
320 data
= readl(sm
->regs
+ reg
);
324 writel(data
, sm
->regs
+ reg
);
327 spin_unlock_irqrestore(&sm
->reg_lock
, save
);
332 EXPORT_SYMBOL_GPL(sm501_modify_reg
);
334 unsigned long sm501_gpio_get(struct device
*dev
,
337 struct sm501_devdata
*sm
= dev_get_drvdata(dev
);
338 unsigned long result
;
341 reg
= (gpio
> 32) ? SM501_GPIO_DATA_HIGH
: SM501_GPIO_DATA_LOW
;
342 result
= readl(sm
->regs
+ reg
);
344 result
>>= (gpio
& 31);
348 EXPORT_SYMBOL_GPL(sm501_gpio_get
);
350 void sm501_gpio_set(struct device
*dev
,
355 struct sm501_devdata
*sm
= dev_get_drvdata(dev
);
357 unsigned long bit
= 1 << (gpio
& 31);
362 base
= (gpio
> 32) ? SM501_GPIO_DATA_HIGH
: SM501_GPIO_DATA_LOW
;
365 spin_lock_irqsave(&sm
->reg_lock
, save
);
367 val
= readl(sm
->regs
+ base
) & ~bit
;
370 writel(val
, sm
->regs
+ base
);
372 val
= readl(sm
->regs
+ SM501_GPIO_DDR_LOW
) & ~bit
;
376 writel(val
, sm
->regs
+ SM501_GPIO_DDR_LOW
);
379 spin_unlock_irqrestore(&sm
->reg_lock
, save
);
383 EXPORT_SYMBOL_GPL(sm501_gpio_set
);
388 * alters the power active gate to set specific units on or off
391 int sm501_unit_power(struct device
*dev
, unsigned int unit
, unsigned int to
)
393 struct sm501_devdata
*sm
= dev_get_drvdata(dev
);
398 mutex_lock(&sm
->clock_lock
);
400 mode
= readl(sm
->regs
+ SM501_POWER_MODE_CONTROL
);
401 gate
= readl(sm
->regs
+ SM501_CURRENT_GATE
);
402 clock
= readl(sm
->regs
+ SM501_CURRENT_CLOCK
);
404 mode
&= 3; /* get current power mode */
406 if (unit
>= ARRAY_SIZE(sm
->unit_power
)) {
407 dev_err(dev
, "%s: bad unit %d\n", __FUNCTION__
, unit
);
411 dev_dbg(sm
->dev
, "%s: unit %d, cur %d, to %d\n", __FUNCTION__
, unit
,
412 sm
->unit_power
[unit
], to
);
414 if (to
== 0 && sm
->unit_power
[unit
] == 0) {
415 dev_err(sm
->dev
, "unit %d is already shutdown\n", unit
);
419 sm
->unit_power
[unit
] += to
? 1 : -1;
420 to
= sm
->unit_power
[unit
] ? 1 : 0;
423 if (gate
& (1 << unit
))
427 if (!(gate
& (1 << unit
)))
429 gate
&= ~(1 << unit
);
434 writel(gate
, sm
->regs
+ SM501_POWER_MODE_0_GATE
);
435 writel(clock
, sm
->regs
+ SM501_POWER_MODE_0_CLOCK
);
440 writel(gate
, sm
->regs
+ SM501_POWER_MODE_1_GATE
);
441 writel(clock
, sm
->regs
+ SM501_POWER_MODE_1_CLOCK
);
449 writel(mode
, sm
->regs
+ SM501_POWER_MODE_CONTROL
);
452 dev_dbg(sm
->dev
, "gate %08lx, clock %08lx, mode %08lx\n",
455 sm501_mdelay(sm
, 16);
458 mutex_unlock(&sm
->clock_lock
);
462 EXPORT_SYMBOL_GPL(sm501_unit_power
);
465 /* Perform a rounded division. */
466 static long sm501fb_round_div(long num
, long denom
)
468 /* n / d + 1 / 2 = (2n + d) / 2d */
469 return (2 * num
+ denom
) / (2 * denom
);
472 /* clock value structure. */
477 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
479 unsigned int m
, n
, k
;
480 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
483 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
487 * Calculates the nearest discrete clock frequency that
488 * can be achieved with the specified input clock.
489 * the maximum divisor is 3 or 5
492 static int sm501_calc_clock(unsigned long freq
,
493 struct sm501_clock
*clock
,
503 /* try dividers 1 and 3 for CRT and for panel,
504 try divider 5 for panel only.*/
506 for (divider
= 1; divider
<= max_div
; divider
+= 2) {
507 /* try all 8 shift values.*/
508 for (shift
= 0; shift
< 8; shift
++) {
509 /* Calculate difference to requested clock */
510 diff
= sm501fb_round_div(mclk
, divider
<< shift
) - freq
;
514 /* If it is less than the current, use it */
515 if (diff
< *best_diff
) {
519 clock
->divider
= divider
;
520 clock
->shift
= shift
;
531 * Calculates the nearest discrete clock frequency that can be
532 * achieved using the programmable PLL.
533 * the maximum divisor is 3 or 5
536 static unsigned long sm501_calc_pll(unsigned long freq
,
537 struct sm501_clock
*clock
,
541 unsigned int m
, n
, k
;
542 long best_diff
= 999999999;
545 * The SM502 datasheet doesn't specify the min/max values for M and N.
546 * N = 1 at least doesn't work in practice.
548 for (m
= 2; m
<= 255; m
++) {
549 for (n
= 2; n
<= 127; n
++) {
550 for (k
= 0; k
<= 1; k
++) {
551 mclk
= (24000000UL * m
/ n
) >> k
;
553 if (sm501_calc_clock(freq
, clock
, max_div
,
563 /* Return best clock. */
564 return clock
->mclk
/ (clock
->divider
<< clock
->shift
);
567 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
568 /* sm501_select_clock
570 <<<<<<< HEAD:drivers/mfd/sm501.c
571 * selects nearest discrete clock frequency the SM501 can achive
573 * Calculates the nearest discrete clock frequency that can be
574 * achieved using the 288MHz and 336MHz PLLs.
575 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a:drivers/mfd/sm501.c
576 * the maximum divisor is 3 or 5
578 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
581 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
582 static unsigned long sm501_select_clock(unsigned long freq
,
583 struct sm501_clock
*clock
,
587 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
592 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
593 long best_diff
= 999999999;
595 /* Try 288MHz and 336MHz clocks. */
596 for (mclk
= 288000000; mclk
<= 336000000; mclk
+= 48000000) {
597 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
598 /* try dividers 1 and 3 for CRT and for panel,
599 try divider 5 for panel only.*/
601 for (divider
= 1; divider
<= max_div
; divider
+= 2) {
602 /* try all 8 shift values.*/
603 for (shift
= 0; shift
< 8; shift
++) {
604 /* Calculate difference to requested clock */
605 diff
= sm501fb_round_div(mclk
, divider
<< shift
) - freq
;
609 /* If it is less than the current, use it */
610 if (diff
< best_diff
) {
614 clock
->divider
= divider
;
615 clock
->shift
= shift
;
620 sm501_calc_clock(freq
, clock
, max_div
, mclk
, &best_diff
);
621 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
624 /* Return best clock. */
625 return clock
->mclk
/ (clock
->divider
<< clock
->shift
);
630 * set one of the four clock sources to the closest available frequency to
634 unsigned long sm501_set_clock(struct device
*dev
,
636 unsigned long req_freq
)
638 struct sm501_devdata
*sm
= dev_get_drvdata(dev
);
639 unsigned long mode
= readl(sm
->regs
+ SM501_POWER_MODE_CONTROL
);
640 unsigned long gate
= readl(sm
->regs
+ SM501_CURRENT_GATE
);
641 unsigned long clock
= readl(sm
->regs
+ SM501_CURRENT_CLOCK
);
643 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
645 unsigned int pll_reg
= 0;
646 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
647 unsigned long sm501_freq
; /* the actual frequency acheived */
649 struct sm501_clock to
;
651 /* find achivable discrete frequency and setup register value
652 * accordingly, V2XCLK, MCLK and M1XCLK are the same P2XCLK
653 * has an extra bit for the divider */
656 case SM501_CLOCK_P2XCLK
:
657 /* This clock is divided in half so to achive the
658 * requested frequency the value must be multiplied by
659 * 2. This clock also has an additional pre divisor */
661 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
662 sm501_freq
= (sm501_select_clock(2 * req_freq
, &to
, 5) / 2);
663 reg
=to
.shift
& 0x07;/* bottom 3 bits are shift */
665 reg
|= 0x08; /* /3 divider required */
666 else if (to
.divider
== 5)
667 reg
|= 0x10; /* /5 divider required */
668 if (to
.mclk
!= 288000000)
669 reg
|= 0x20; /* which mclk pll is source */
671 if (sm
->rev
>= 0xC0) {
672 /* SM502 -> use the programmable PLL */
673 sm501_freq
= (sm501_calc_pll(2 * req_freq
,
675 reg
= to
.shift
& 0x07;/* bottom 3 bits are shift */
677 reg
|= 0x08; /* /3 divider required */
678 else if (to
.divider
== 5)
679 reg
|= 0x10; /* /5 divider required */
680 reg
|= 0x40; /* select the programmable PLL */
681 pll_reg
= 0x20000 | (to
.k
<< 15) | (to
.n
<< 8) | to
.m
;
683 sm501_freq
= (sm501_select_clock(2 * req_freq
,
685 reg
= to
.shift
& 0x07;/* bottom 3 bits are shift */
687 reg
|= 0x08; /* /3 divider required */
688 else if (to
.divider
== 5)
689 reg
|= 0x10; /* /5 divider required */
690 if (to
.mclk
!= 288000000)
691 reg
|= 0x20; /* which mclk pll is source */
693 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
696 case SM501_CLOCK_V2XCLK
:
697 /* This clock is divided in half so to achive the
698 * requested frequency the value must be multiplied by 2. */
700 sm501_freq
= (sm501_select_clock(2 * req_freq
, &to
, 3) / 2);
701 reg
=to
.shift
& 0x07; /* bottom 3 bits are shift */
703 reg
|= 0x08; /* /3 divider required */
704 if (to
.mclk
!= 288000000)
705 reg
|= 0x10; /* which mclk pll is source */
708 case SM501_CLOCK_MCLK
:
709 case SM501_CLOCK_M1XCLK
:
710 /* These clocks are the same and not further divided */
712 sm501_freq
= sm501_select_clock( req_freq
, &to
, 3);
713 reg
=to
.shift
& 0x07; /* bottom 3 bits are shift */
715 reg
|= 0x08; /* /3 divider required */
716 if (to
.mclk
!= 288000000)
717 reg
|= 0x10; /* which mclk pll is source */
721 return 0; /* this is bad */
724 mutex_lock(&sm
->clock_lock
);
726 mode
= readl(sm
->regs
+ SM501_POWER_MODE_CONTROL
);
727 gate
= readl(sm
->regs
+ SM501_CURRENT_GATE
);
728 clock
= readl(sm
->regs
+ SM501_CURRENT_CLOCK
);
730 clock
= clock
& ~(0xFF << clksrc
);
731 clock
|= reg
<<clksrc
;
733 mode
&= 3; /* find current mode */
737 writel(gate
, sm
->regs
+ SM501_POWER_MODE_0_GATE
);
738 writel(clock
, sm
->regs
+ SM501_POWER_MODE_0_CLOCK
);
743 writel(gate
, sm
->regs
+ SM501_POWER_MODE_1_GATE
);
744 writel(clock
, sm
->regs
+ SM501_POWER_MODE_1_CLOCK
);
749 mutex_unlock(&sm
->clock_lock
);
753 writel(mode
, sm
->regs
+ SM501_POWER_MODE_CONTROL
);
754 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
758 writel(pll_reg
, sm
->regs
+ SM501_PROGRAMMABLE_PLL_CONTROL
);
760 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
763 dev_info(sm
->dev
, "gate %08lx, clock %08lx, mode %08lx\n",
766 sm501_mdelay(sm
, 16);
767 mutex_unlock(&sm
->clock_lock
);
774 EXPORT_SYMBOL_GPL(sm501_set_clock
);
778 * finds the closest available frequency for a given clock
781 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
782 unsigned long sm501_find_clock(int clksrc
,
784 unsigned long sm501_find_clock(struct device
*dev
,
786 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
787 unsigned long req_freq
)
789 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
791 struct sm501_devdata
*sm
= dev_get_drvdata(dev
);
792 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
793 unsigned long sm501_freq
; /* the frequency achiveable by the 501 */
794 struct sm501_clock to
;
797 case SM501_CLOCK_P2XCLK
:
798 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
799 sm501_freq
= (sm501_select_clock(2 * req_freq
, &to
, 5) / 2);
801 if (sm
->rev
>= 0xC0) {
802 /* SM502 -> use the programmable PLL */
803 sm501_freq
= (sm501_calc_pll(2 * req_freq
,
806 sm501_freq
= (sm501_select_clock(2 * req_freq
,
809 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
812 case SM501_CLOCK_V2XCLK
:
813 sm501_freq
= (sm501_select_clock(2 * req_freq
, &to
, 3) / 2);
816 case SM501_CLOCK_MCLK
:
817 case SM501_CLOCK_M1XCLK
:
818 sm501_freq
= sm501_select_clock(req_freq
, &to
, 3);
822 sm501_freq
= 0; /* error */
828 EXPORT_SYMBOL_GPL(sm501_find_clock
);
830 static struct sm501_device
*to_sm_device(struct platform_device
*pdev
)
832 return container_of(pdev
, struct sm501_device
, pdev
);
835 /* sm501_device_release
837 * A release function for the platform devices we create to allow us to
838 * free any items we allocated
841 static void sm501_device_release(struct device
*dev
)
843 kfree(to_sm_device(to_platform_device(dev
)));
846 /* sm501_create_subdev
848 * Create a skeleton platform device with resources for passing to a
852 static struct platform_device
*
853 sm501_create_subdev(struct sm501_devdata
*sm
,
854 char *name
, unsigned int res_count
)
856 struct sm501_device
*smdev
;
858 smdev
= kzalloc(sizeof(struct sm501_device
) +
859 sizeof(struct resource
) * res_count
, GFP_KERNEL
);
863 smdev
->pdev
.dev
.release
= sm501_device_release
;
865 smdev
->pdev
.name
= name
;
866 smdev
->pdev
.id
= sm
->pdev_id
;
867 smdev
->pdev
.resource
= (struct resource
*)(smdev
+1);
868 smdev
->pdev
.num_resources
= res_count
;
870 smdev
->pdev
.dev
.parent
= sm
->dev
;
875 /* sm501_register_device
877 * Register a platform device created with sm501_create_subdev()
880 static int sm501_register_device(struct sm501_devdata
*sm
,
881 struct platform_device
*pdev
)
883 struct sm501_device
*smdev
= to_sm_device(pdev
);
887 for (ptr
= 0; ptr
< pdev
->num_resources
; ptr
++) {
888 printk("%s[%d] flags %08lx: %08llx..%08llx\n",
890 pdev
->resource
[ptr
].flags
,
891 (unsigned long long)pdev
->resource
[ptr
].start
,
892 (unsigned long long)pdev
->resource
[ptr
].end
);
895 ret
= platform_device_register(pdev
);
898 dev_dbg(sm
->dev
, "registered %s\n", pdev
->name
);
899 list_add_tail(&smdev
->list
, &sm
->devices
);
901 dev_err(sm
->dev
, "error registering %s (%d)\n",
907 /* sm501_create_subio
909 * Fill in an IO resource for a sub device
912 static void sm501_create_subio(struct sm501_devdata
*sm
,
913 struct resource
*res
,
914 resource_size_t offs
,
915 resource_size_t size
)
917 res
->flags
= IORESOURCE_MEM
;
918 res
->parent
= sm
->io_res
;
919 res
->start
= sm
->io_res
->start
+ offs
;
920 res
->end
= res
->start
+ size
- 1;
925 * Fill in an MEM resource for a sub device
928 static void sm501_create_mem(struct sm501_devdata
*sm
,
929 struct resource
*res
,
930 resource_size_t
*offs
,
931 resource_size_t size
)
933 *offs
-= size
; /* adjust memory size */
935 res
->flags
= IORESOURCE_MEM
;
936 res
->parent
= sm
->mem_res
;
937 res
->start
= sm
->mem_res
->start
+ *offs
;
938 res
->end
= res
->start
+ size
- 1;
943 * Fill in an IRQ resource for a sub device
946 static void sm501_create_irq(struct sm501_devdata
*sm
,
947 struct resource
*res
)
949 res
->flags
= IORESOURCE_IRQ
;
951 res
->start
= res
->end
= sm
->irq
;
954 static int sm501_register_usbhost(struct sm501_devdata
*sm
,
955 resource_size_t
*mem_avail
)
957 struct platform_device
*pdev
;
959 pdev
= sm501_create_subdev(sm
, "sm501-usb", 3);
963 sm501_create_subio(sm
, &pdev
->resource
[0], 0x40000, 0x20000);
964 sm501_create_mem(sm
, &pdev
->resource
[1], mem_avail
, 256*1024);
965 sm501_create_irq(sm
, &pdev
->resource
[2]);
967 return sm501_register_device(sm
, pdev
);
970 static int sm501_register_display(struct sm501_devdata
*sm
,
971 resource_size_t
*mem_avail
)
973 struct platform_device
*pdev
;
975 pdev
= sm501_create_subdev(sm
, "sm501-fb", 4);
979 sm501_create_subio(sm
, &pdev
->resource
[0], 0x80000, 0x10000);
980 sm501_create_subio(sm
, &pdev
->resource
[1], 0x100000, 0x50000);
981 sm501_create_mem(sm
, &pdev
->resource
[2], mem_avail
, *mem_avail
);
982 sm501_create_irq(sm
, &pdev
->resource
[3]);
984 return sm501_register_device(sm
, pdev
);
989 * Debug attribute to attach to parent device to show core registers
992 static ssize_t
sm501_dbg_regs(struct device
*dev
,
993 struct device_attribute
*attr
, char *buff
)
995 struct sm501_devdata
*sm
= dev_get_drvdata(dev
) ;
1000 for (reg
= 0x00; reg
< 0x70; reg
+= 4) {
1001 ret
= sprintf(ptr
, "%08x = %08x\n",
1002 reg
, readl(sm
->regs
+ reg
));
1010 static DEVICE_ATTR(dbg_regs
, 0666, sm501_dbg_regs
, NULL
);
1014 * Helper function for the init code to setup a register
1016 * clear the bits which are set in r->mask, and then set
1017 * the bits set in r->set.
1020 static inline void sm501_init_reg(struct sm501_devdata
*sm
,
1022 struct sm501_reg_init
*r
)
1026 tmp
= readl(sm
->regs
+ reg
);
1029 writel(tmp
, sm
->regs
+ reg
);
1034 * Setup core register values
1037 static void sm501_init_regs(struct sm501_devdata
*sm
,
1038 struct sm501_initdata
*init
)
1040 sm501_misc_control(sm
->dev
,
1041 init
->misc_control
.set
,
1042 init
->misc_control
.mask
);
1044 sm501_init_reg(sm
, SM501_MISC_TIMING
, &init
->misc_timing
);
1045 sm501_init_reg(sm
, SM501_GPIO31_0_CONTROL
, &init
->gpio_low
);
1046 sm501_init_reg(sm
, SM501_GPIO63_32_CONTROL
, &init
->gpio_high
);
1049 dev_info(sm
->dev
, "setting M1XCLK to %ld\n", init
->m1xclk
);
1050 sm501_set_clock(sm
->dev
, SM501_CLOCK_M1XCLK
, init
->m1xclk
);
1054 dev_info(sm
->dev
, "setting MCLK to %ld\n", init
->mclk
);
1055 sm501_set_clock(sm
->dev
, SM501_CLOCK_MCLK
, init
->mclk
);
1060 /* Check the PLL sources for the M1CLK and M1XCLK
1062 * If the M1CLK and M1XCLKs are not sourced from the same PLL, then
1063 * there is a risk (see errata AB-5) that the SM501 will cease proper
1064 * function. If this happens, then it is likely the SM501 will
1068 static int sm501_check_clocks(struct sm501_devdata
*sm
)
1070 unsigned long pwrmode
= readl(sm
->regs
+ SM501_CURRENT_CLOCK
);
1071 unsigned long msrc
= (pwrmode
& SM501_POWERMODE_M_SRC
);
1072 unsigned long m1src
= (pwrmode
& SM501_POWERMODE_M1_SRC
);
1074 return ((msrc
== 0 && m1src
!= 0) || (msrc
!= 0 && m1src
== 0));
1077 static unsigned int sm501_mem_local
[] = {
1088 * Common init code for an SM501
1091 static int sm501_init_dev(struct sm501_devdata
*sm
)
1093 resource_size_t mem_avail
;
1094 unsigned long dramctrl
;
1095 unsigned long devid
;
1098 mutex_init(&sm
->clock_lock
);
1099 spin_lock_init(&sm
->reg_lock
);
1101 INIT_LIST_HEAD(&sm
->devices
);
1103 devid
= readl(sm
->regs
+ SM501_DEVICEID
);
1105 if ((devid
& SM501_DEVICEID_IDMASK
) != SM501_DEVICEID_SM501
) {
1106 dev_err(sm
->dev
, "incorrect device id %08lx\n", devid
);
1110 dramctrl
= readl(sm
->regs
+ SM501_DRAM_CONTROL
);
1111 mem_avail
= sm501_mem_local
[(dramctrl
>> 13) & 0x7];
1113 dev_info(sm
->dev
, "SM501 At %p: Version %08lx, %ld Mb, IRQ %d\n",
1114 sm
->regs
, devid
, (unsigned long)mem_avail
>> 20, sm
->irq
);
1116 <<<<<<< HEAD
:drivers
/mfd
/sm501
.c
1118 sm
->rev
= devid
& SM501_DEVICEID_REVMASK
;
1120 >>>>>>> 264e3e889d86e552b4191d69bb60f4f3b383135a
:drivers
/mfd
/sm501
.c
1121 sm501_dump_gate(sm
);
1123 ret
= device_create_file(sm
->dev
, &dev_attr_dbg_regs
);
1125 dev_err(sm
->dev
, "failed to create debug regs file\n");
1129 /* check to see if we have some device initialisation */
1132 struct sm501_platdata
*pdata
= sm
->platdata
;
1135 sm501_init_regs(sm
, sm
->platdata
->init
);
1137 if (pdata
->init
->devices
& SM501_USE_USB_HOST
)
1138 sm501_register_usbhost(sm
, &mem_avail
);
1142 ret
= sm501_check_clocks(sm
);
1144 dev_err(sm
->dev
, "M1X and M clocks sourced from different "
1149 /* always create a framebuffer */
1150 sm501_register_display(sm
, &mem_avail
);
1155 static int sm501_plat_probe(struct platform_device
*dev
)
1157 struct sm501_devdata
*sm
;
1160 sm
= kzalloc(sizeof(struct sm501_devdata
), GFP_KERNEL
);
1162 dev_err(&dev
->dev
, "no memory for device data\n");
1167 sm
->dev
= &dev
->dev
;
1168 sm
->pdev_id
= dev
->id
;
1169 sm
->irq
= platform_get_irq(dev
, 0);
1170 sm
->io_res
= platform_get_resource(dev
, IORESOURCE_MEM
, 1);
1171 sm
->mem_res
= platform_get_resource(dev
, IORESOURCE_MEM
, 0);
1172 sm
->platdata
= dev
->dev
.platform_data
;
1175 dev_err(&dev
->dev
, "failed to get irq resource\n");
1180 if (sm
->io_res
== NULL
|| sm
->mem_res
== NULL
) {
1181 dev_err(&dev
->dev
, "failed to get IO resource\n");
1186 sm
->regs_claim
= request_mem_region(sm
->io_res
->start
,
1189 if (sm
->regs_claim
== NULL
) {
1190 dev_err(&dev
->dev
, "cannot claim registers\n");
1195 platform_set_drvdata(dev
, sm
);
1197 sm
->regs
= ioremap(sm
->io_res
->start
,
1198 (sm
->io_res
->end
- sm
->io_res
->start
) - 1);
1200 if (sm
->regs
== NULL
) {
1201 dev_err(&dev
->dev
, "cannot remap registers\n");
1206 return sm501_init_dev(sm
);
1209 release_resource(sm
->regs_claim
);
1210 kfree(sm
->regs_claim
);
1219 /* power management support */
1221 static int sm501_plat_suspend(struct platform_device
*pdev
, pm_message_t state
)
1223 struct sm501_devdata
*sm
= platform_get_drvdata(pdev
);
1226 sm
->pm_misc
= readl(sm
->regs
+ SM501_MISC_CONTROL
);
1228 sm501_dump_regs(sm
);
1232 static int sm501_plat_resume(struct platform_device
*pdev
)
1234 struct sm501_devdata
*sm
= platform_get_drvdata(pdev
);
1236 sm501_dump_regs(sm
);
1237 sm501_dump_gate(sm
);
1240 /* check to see if we are in the same state as when suspended */
1242 if (readl(sm
->regs
+ SM501_MISC_CONTROL
) != sm
->pm_misc
) {
1243 dev_info(sm
->dev
, "SM501_MISC_CONTROL changed over sleep\n");
1244 writel(sm
->pm_misc
, sm
->regs
+ SM501_MISC_CONTROL
);
1246 /* our suspend causes the controller state to change,
1247 * either by something attempting setup, power loss,
1248 * or an external reset event on power change */
1250 if (sm
->platdata
&& sm
->platdata
->init
) {
1251 sm501_init_regs(sm
, sm
->platdata
->init
);
1255 /* dump our state from resume */
1257 sm501_dump_regs(sm
);
1265 #define sm501_plat_suspend NULL
1266 #define sm501_plat_resume NULL
1269 /* Initialisation data for PCI devices */
1271 static struct sm501_initdata sm501_pci_initdata
= {
1273 .set
= 0x3F000000, /* 24bit panel */
1277 .set
= 0x010100, /* SDRAM timing */
1281 .set
= SM501_MISC_PNL_24BIT
,
1285 .devices
= SM501_USE_ALL
,
1287 /* Errata AB-3 says that 72MHz is the fastest available
1288 * for 33MHZ PCI with proper bus-mastering operation */
1291 .m1xclk
= 144 * MHZ
,
1294 static struct sm501_platdata_fbsub sm501_pdata_fbsub
= {
1295 .flags
= (SM501FB_FLAG_USE_INIT_MODE
|
1296 SM501FB_FLAG_USE_HWCURSOR
|
1297 SM501FB_FLAG_USE_HWACCEL
|
1298 SM501FB_FLAG_DISABLE_AT_EXIT
),
1301 static struct sm501_platdata_fb sm501_fb_pdata
= {
1302 .fb_route
= SM501_FB_OWN
,
1303 .fb_crt
= &sm501_pdata_fbsub
,
1304 .fb_pnl
= &sm501_pdata_fbsub
,
1307 static struct sm501_platdata sm501_pci_platdata
= {
1308 .init
= &sm501_pci_initdata
,
1309 .fb
= &sm501_fb_pdata
,
1312 static int sm501_pci_probe(struct pci_dev
*dev
,
1313 const struct pci_device_id
*id
)
1315 struct sm501_devdata
*sm
;
1318 sm
= kzalloc(sizeof(struct sm501_devdata
), GFP_KERNEL
);
1320 dev_err(&dev
->dev
, "no memory for device data\n");
1325 /* set a default set of platform data */
1326 dev
->dev
.platform_data
= sm
->platdata
= &sm501_pci_platdata
;
1328 /* set a hopefully unique id for our child platform devices */
1329 sm
->pdev_id
= 32 + dev
->devfn
;
1331 pci_set_drvdata(dev
, sm
);
1333 err
= pci_enable_device(dev
);
1335 dev_err(&dev
->dev
, "cannot enable device\n");
1339 sm
->dev
= &dev
->dev
;
1343 /* if the system is big-endian, we most probably have a
1344 * translation in the IO layer making the PCI bus little endian
1345 * so make the framebuffer swapped pixels */
1347 sm501_fb_pdata
.flags
|= SM501_FBPD_SWAP_FB_ENDIAN
;
1350 /* check our resources */
1352 if (!(pci_resource_flags(dev
, 0) & IORESOURCE_MEM
)) {
1353 dev_err(&dev
->dev
, "region #0 is not memory?\n");
1358 if (!(pci_resource_flags(dev
, 1) & IORESOURCE_MEM
)) {
1359 dev_err(&dev
->dev
, "region #1 is not memory?\n");
1364 /* make our resources ready for sharing */
1366 sm
->io_res
= &dev
->resource
[1];
1367 sm
->mem_res
= &dev
->resource
[0];
1369 sm
->regs_claim
= request_mem_region(sm
->io_res
->start
,
1371 if (sm
->regs_claim
== NULL
) {
1372 dev_err(&dev
->dev
, "cannot claim registers\n");
1377 sm
->regs
= ioremap(pci_resource_start(dev
, 1),
1378 pci_resource_len(dev
, 1));
1380 if (sm
->regs
== NULL
) {
1381 dev_err(&dev
->dev
, "cannot remap registers\n");
1390 release_resource(sm
->regs_claim
);
1391 kfree(sm
->regs_claim
);
1393 pci_disable_device(dev
);
1395 pci_set_drvdata(dev
, NULL
);
1401 static void sm501_remove_sub(struct sm501_devdata
*sm
,
1402 struct sm501_device
*smdev
)
1404 list_del(&smdev
->list
);
1405 platform_device_unregister(&smdev
->pdev
);
1408 static void sm501_dev_remove(struct sm501_devdata
*sm
)
1410 struct sm501_device
*smdev
, *tmp
;
1412 list_for_each_entry_safe(smdev
, tmp
, &sm
->devices
, list
)
1413 sm501_remove_sub(sm
, smdev
);
1415 device_remove_file(sm
->dev
, &dev_attr_dbg_regs
);
1418 static void sm501_pci_remove(struct pci_dev
*dev
)
1420 struct sm501_devdata
*sm
= pci_get_drvdata(dev
);
1422 sm501_dev_remove(sm
);
1425 release_resource(sm
->regs_claim
);
1426 kfree(sm
->regs_claim
);
1428 pci_set_drvdata(dev
, NULL
);
1429 pci_disable_device(dev
);
1432 static int sm501_plat_remove(struct platform_device
*dev
)
1434 struct sm501_devdata
*sm
= platform_get_drvdata(dev
);
1436 sm501_dev_remove(sm
);
1439 release_resource(sm
->regs_claim
);
1440 kfree(sm
->regs_claim
);
1445 static struct pci_device_id sm501_pci_tbl
[] = {
1446 { 0x126f, 0x0501, PCI_ANY_ID
, PCI_ANY_ID
, 0, 0, 0 },
1450 MODULE_DEVICE_TABLE(pci
, sm501_pci_tbl
);
1452 static struct pci_driver sm501_pci_drv
= {
1454 .id_table
= sm501_pci_tbl
,
1455 .probe
= sm501_pci_probe
,
1456 .remove
= sm501_pci_remove
,
1459 static struct platform_driver sm501_plat_drv
= {
1462 .owner
= THIS_MODULE
,
1464 .probe
= sm501_plat_probe
,
1465 .remove
= sm501_plat_remove
,
1466 .suspend
= sm501_plat_suspend
,
1467 .resume
= sm501_plat_resume
,
1470 static int __init
sm501_base_init(void)
1472 platform_driver_register(&sm501_plat_drv
);
1473 return pci_register_driver(&sm501_pci_drv
);
1476 static void __exit
sm501_base_exit(void)
1478 platform_driver_unregister(&sm501_plat_drv
);
1479 pci_unregister_driver(&sm501_pci_drv
);
1482 module_init(sm501_base_init
);
1483 module_exit(sm501_base_exit
);
1485 MODULE_DESCRIPTION("SM501 Core Driver");
1486 MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>, Vincent Sanders");
1487 MODULE_LICENSE("GPL v2");