Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history
yaml
---
r: 95088
b: refs/heads/master
c: a7535ba
h: refs/heads/master
v: v3
  • Loading branch information
Eric Miao authored and Linus Torvalds committed Apr 30, 2008
1 parent 8dcc9a2 commit 29e0cd7
Show file tree
Hide file tree
Showing 2 changed files with 36 additions and 25 deletions.
2 changes: 1 addition & 1 deletion [refs]
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: 0454bd09de7380aac464c09018e6a533f7247b0d
refs/heads/master: a7535ba730e13db037bd22c79c3805690d0945a2
59 changes: 35 additions & 24 deletions trunk/drivers/video/pxafb.c
Original file line number Diff line number Diff line change
Expand Up @@ -71,6 +71,18 @@ static int pxafb_activate_var(struct fb_var_screeninfo *var,
struct pxafb_info *);
static void set_ctrlr_state(struct pxafb_info *fbi, u_int state);

static inline unsigned long
lcd_readl(struct pxafb_info *fbi, unsigned int off)
{
return __raw_readl(fbi->mmio_base + off);
}

static inline void
lcd_writel(struct pxafb_info *fbi, unsigned int off, unsigned long val)
{
__raw_writel(val, fbi->mmio_base + off);
}

static inline void pxafb_schedule_work(struct pxafb_info *fbi, u_int state)
{
unsigned long flags;
Expand Down Expand Up @@ -684,8 +696,7 @@ static int pxafb_activate_var(struct fb_var_screeninfo *var,
fbi->reg_lccr1 = new_regs.lccr1;
fbi->reg_lccr2 = new_regs.lccr2;
fbi->reg_lccr3 = new_regs.lccr3;
fbi->reg_lccr4 = __raw_readl(fbi->mmio_base + LCCR4) &
(~LCCR4_PAL_FOR_MASK);
fbi->reg_lccr4 = lcd_readl(fbi, LCCR4) & ~LCCR4_PAL_FOR_MASK;
fbi->reg_lccr4 |= (fbi->lccr4 & LCCR4_PAL_FOR_MASK);
set_hsync_time(fbi, pcd);
local_irq_restore(flags);
Expand All @@ -694,12 +705,12 @@ static int pxafb_activate_var(struct fb_var_screeninfo *var,
* Only update the registers if the controller is enabled
* and something has changed.
*/
if ((__raw_readl(fbi->mmio_base + LCCR0) != fbi->reg_lccr0) ||
(__raw_readl(fbi->mmio_base + LCCR1) != fbi->reg_lccr1) ||
(__raw_readl(fbi->mmio_base + LCCR2) != fbi->reg_lccr2) ||
(__raw_readl(fbi->mmio_base + LCCR3) != fbi->reg_lccr3) ||
(__raw_readl(fbi->mmio_base + FDADR0) != fbi->fdadr[0]) ||
(__raw_readl(fbi->mmio_base + FDADR1) != fbi->fdadr[1]))
if ((lcd_readl(fbi, LCCR0) != fbi->reg_lccr0) ||
(lcd_readl(fbi, LCCR1) != fbi->reg_lccr1) ||
(lcd_readl(fbi, LCCR2) != fbi->reg_lccr2) ||
(lcd_readl(fbi, LCCR3) != fbi->reg_lccr3) ||
(lcd_readl(fbi, FDADR0) != fbi->fdadr[0]) ||
(lcd_readl(fbi, FDADR1) != fbi->fdadr[1]))
pxafb_schedule_work(fbi, C_REENABLE);

return 0;
Expand Down Expand Up @@ -785,14 +796,14 @@ static void pxafb_enable_controller(struct pxafb_info *fbi)
clk_enable(fbi->clk);

/* Sequence from 11.7.10 */
__raw_writel(fbi->reg_lccr3, fbi->mmio_base + LCCR3);
__raw_writel(fbi->reg_lccr2, fbi->mmio_base + LCCR2);
__raw_writel(fbi->reg_lccr1, fbi->mmio_base + LCCR1);
__raw_writel(fbi->reg_lccr0 & ~LCCR0_ENB, fbi->mmio_base + LCCR0);

__raw_writel(fbi->fdadr[0], fbi->mmio_base + FDADR0);
__raw_writel(fbi->fdadr[1], fbi->mmio_base + FDADR1);
__raw_writel(fbi->reg_lccr0 | LCCR0_ENB, fbi->mmio_base + LCCR0);
lcd_writel(fbi, LCCR3, fbi->reg_lccr3);
lcd_writel(fbi, LCCR2, fbi->reg_lccr2);
lcd_writel(fbi, LCCR1, fbi->reg_lccr1);
lcd_writel(fbi, LCCR0, fbi->reg_lccr0 & ~LCCR0_ENB);

lcd_writel(fbi, FDADR0, fbi->fdadr[0]);
lcd_writel(fbi, FDADR1, fbi->fdadr[1]);
lcd_writel(fbi, LCCR0, fbi->reg_lccr0 | LCCR0_ENB);
}

static void pxafb_disable_controller(struct pxafb_info *fbi)
Expand All @@ -805,11 +816,11 @@ static void pxafb_disable_controller(struct pxafb_info *fbi)
add_wait_queue(&fbi->ctrlr_wait, &wait);

/* Clear LCD Status Register */
__raw_writel(0xffffffff, fbi->mmio_base + LCSR);
lcd_writel(fbi, LCSR, 0xffffffff);

lccr0 = __raw_readl(fbi->mmio_base + LCCR0) & ~LCCR0_LDM;
__raw_writel(lccr0, fbi->mmio_base + LCCR0);
__raw_writel(lccr0 | LCCR0_DIS, fbi->mmio_base + LCCR0);
lccr0 = lcd_readl(fbi, LCCR0) & ~LCCR0_LDM;
lcd_writel(fbi, LCCR0, lccr0);
lcd_writel(fbi, LCCR0, lccr0 | LCCR0_DIS);

schedule_timeout(200 * HZ / 1000);
remove_wait_queue(&fbi->ctrlr_wait, &wait);
Expand All @@ -824,15 +835,15 @@ static void pxafb_disable_controller(struct pxafb_info *fbi)
static irqreturn_t pxafb_handle_irq(int irq, void *dev_id)
{
struct pxafb_info *fbi = dev_id;
unsigned int lccr0, lcsr = __raw_readl(fbi->mmio_base + LCSR);
unsigned int lccr0, lcsr = lcd_readl(fbi, LCSR);

if (lcsr & LCSR_LDD) {
lccr0 = __raw_readl(fbi->mmio_base + LCCR0) | LCCR0_LDM;
__raw_writel(lccr0, fbi->mmio_base + LCCR0);
lccr0 = lcd_readl(fbi, LCCR0);
lcd_writel(fbi, LCCR0, lccr0 | LCCR0_LDM);
wake_up(&fbi->ctrlr_wait);
}

__raw_writel(lcsr, fbi->mmio_base + LCSR);
lcd_writel(fbi, LCSR, lcsr);
return IRQ_HANDLED;
}

Expand Down

0 comments on commit 29e0cd7

Please sign in to comment.