m68k/atari - atafb: convert allocation of fb ram to new interface

The new atari_stram_alloc interface returns kernel virtual addresses
even if the kernel runs in FastRAM. These addresses are not
guaranteed to be identical with the physical addresses. Since ST-RAM
mappings have not been set up by mem_init, virt_to_phys() and its
cousin do not work and the atari_stram_to_phys() etc. helpers must
be used to determine physical addresses.

fb.fix->smem_start needs physical addresses, fb.par->screen_base
needs virtual addresses. Take care of the virt-to-phys conversion
both on fb init and par changes.

Signed-off-by: Michael Schmitz <schmitz@debian.org>
Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>

1 files changed, 26 insertions, 23 deletions

diff --git a/drivers/video/fbdev/atafb.c b/drivers/video/fbdev/atafb.c
index e21d1f58554c..4953b657635e 100644
--- a/drivers/video/fbdev/atafb.c
+++ b/drivers/video/fbdev/atafb.c
@@ -191,7 +191,7 @@ static struct fb_info fb_info = {
 };
 
 static void *screen_base;       /* base address of screen */
-static void *real_screen_base;  /* (only for Overscan) */
+static unsigned long phys_screen_base;  /* (only for Overscan) */
 
 static int screen_len;
 
@@ -213,7 +213,8 @@ static unsigned int external_yres;
  */
 static unsigned int external_depth;
 static int external_pmode;
-static void *external_addr;
+static void *external_screen_base;
+static unsigned long external_addr;
 static unsigned long external_len;
 static unsigned long external_vgaiobase;
 static unsigned int external_bitspercol = 6;
@@ -592,7 +593,7 @@ static int tt_encode_fix(struct fb_fix_screeninfo *fix, struct atafb_par *par)
         int mode;
 
         strcpy(fix->id, "Atari Builtin");
-        fix->smem_start = (unsigned long)real_screen_base;
+        fix->smem_start = phys_screen_base;
         fix->smem_len = screen_len;
         fix->type = FB_TYPE_INTERLEAVED_PLANES;
         fix->type_aux = 2;
@@ -790,7 +791,7 @@ static void tt_get_par(struct atafb_par *par)
         addr = ((shifter.bas_hi & 0xff) << 16) |
                ((shifter.bas_md & 0xff) << 8)  |
                ((shifter.bas_lo & 0xff));
-        par->screen_base = phys_to_virt(addr);
+        par->screen_base = atari_stram_to_virt(addr);
 }
 
 static void tt_set_par(struct atafb_par *par)
@@ -888,7 +889,7 @@ static int falcon_encode_fix(struct fb_fix_screeninfo *fix,
                              struct atafb_par *par)
 {
         strcpy(fix->id, "Atari Builtin");
-        fix->smem_start = (unsigned long)real_screen_base;
+        fix->smem_start = phys_screen_base;
         fix->smem_len = screen_len;
         fix->type = FB_TYPE_INTERLEAVED_PLANES;
         fix->type_aux = 2;
@@ -1584,7 +1585,7 @@ static void falcon_get_par(struct atafb_par *par)
         addr = (shifter.bas_hi & 0xff) << 16 |
                (shifter.bas_md & 0xff) << 8  |
                (shifter.bas_lo & 0xff);
-        par->screen_base = phys_to_virt(addr);
+        par->screen_base = atari_stram_to_virt(addr);
 
         /* derived parameters */
         hw->ste_mode = (hw->f_shift & 0x510) == 0 && hw->st_shift == 0x100;
@@ -1814,7 +1815,7 @@ static int stste_encode_fix(struct fb_fix_screeninfo *fix,
         int mode;
 
         strcpy(fix->id, "Atari Builtin");
-        fix->smem_start = (unsigned long)real_screen_base;
+        fix->smem_start = phys_screen_base;
         fix->smem_len = screen_len;
         fix->type = FB_TYPE_INTERLEAVED_PLANES;
         fix->type_aux = 2;
@@ -1980,7 +1981,7 @@ static void stste_get_par(struct atafb_par *par)
                ((shifter.bas_md & 0xff) << 8);
         if (ATARIHW_PRESENT(EXTD_SHIFTER))
                 addr |= (shifter.bas_lo & 0xff);
-        par->screen_base = phys_to_virt(addr);
+        par->screen_base = atari_stram_to_virt(addr);
 }
 
 static void stste_set_par(struct atafb_par *par)
@@ -2039,7 +2040,7 @@ static int stste_detect(void)
 static void stste_set_screen_base(void *s_base)
 {
         unsigned long addr;
-        addr = virt_to_phys(s_base);
+        addr = atari_stram_to_phys(s_base);
         /* Setup Screen Memory */
         shifter.bas_hi = (unsigned char)((addr & 0xff0000) >> 16);
         shifter.bas_md = (unsigned char)((addr & 0x00ff00) >> 8);
@@ -2113,7 +2114,7 @@ static void st_ovsc_switch(void)
 static int ext_encode_fix(struct fb_fix_screeninfo *fix, struct atafb_par *par)
 {
         strcpy(fix->id, "Unknown Extern");
-        fix->smem_start = (unsigned long)external_addr;
+        fix->smem_start = external_addr;
         fix->smem_len = PAGE_ALIGN(external_len);
         if (external_depth == 1) {
                 fix->type = FB_TYPE_PACKED_PIXELS;
@@ -2213,7 +2214,7 @@ static int ext_encode_var(struct fb_var_screeninfo *var, struct atafb_par *par)
 
 static void ext_get_par(struct atafb_par *par)
 {
-        par->screen_base = external_addr;
+        par->screen_base = external_screen_base;
 }
 
 static void ext_set_par(struct atafb_par *par)
@@ -2286,7 +2287,7 @@ static void set_screen_base(void *s_base)
 {
         unsigned long addr;
 
-        addr = virt_to_phys(s_base);
+        addr = atari_stram_to_phys(s_base);
         /* Setup Screen Memory */
         shifter.bas_hi = (unsigned char)((addr & 0xff0000) >> 16);
         shifter.bas_md = (unsigned char)((addr & 0x00ff00) >> 8);
@@ -2433,7 +2434,9 @@ static void atafb_set_disp(struct fb_info *info)
         atafb_get_var(&info->var, info);
         atafb_get_fix(&info->fix, info);
 
-        info->screen_base = (void *)info->fix.smem_start;
+        /* Note: smem_start derives from phys_screen_base, not screen_base! */
+        info->screen_base = (external_addr ? external_screen_base :
+                                atari_stram_to_virt(info->fix.smem_start));
 }
 
 static int atafb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
@@ -2904,7 +2907,7 @@ static void __init atafb_setup_ext(char *spec)
         external_yres = yres;
         external_depth = depth;
         external_pmode = planes;
-        external_addr = (void *)addr;
+        external_addr = addr;
         external_len = len;
 
         if (external_card_type == IS_MV300) {
@@ -3166,30 +3169,30 @@ int __init atafb_init(void)
                 memset(screen_base, 0, mem_req);
                 pad = -(unsigned long)screen_base & (PAGE_SIZE - 1);
                 screen_base += pad;
-                real_screen_base = screen_base + ovsc_offset;
+                phys_screen_base = atari_stram_to_phys(screen_base + ovsc_offset);
                 screen_len = (mem_req - pad - ovsc_offset) & PAGE_MASK;
                 st_ovsc_switch();
                 if (CPU_IS_040_OR_060) {
                         /* On a '040+, the cache mode of video RAM must be set to
                          * write-through also for internal video hardware! */
-                        cache_push(virt_to_phys(screen_base), screen_len);
+                        cache_push(atari_stram_to_phys(screen_base), screen_len);
                         kernel_set_cachemode(screen_base, screen_len,
                                              IOMAP_WRITETHROUGH);
                 }
-                printk("atafb: screen_base %p real_screen_base %p screen_len %d\n",
-                        screen_base, real_screen_base, screen_len);
+                printk("atafb: screen_base %p phys_screen_base %lx screen_len %d\n",
+                        screen_base, phys_screen_base, screen_len);
 #ifdef ATAFB_EXT
         } else {
                 /* Map the video memory (physical address given) to somewhere
                  * in the kernel address space.
                  */
-                external_addr = ioremap_writethrough((unsigned long)external_addr,
+                external_screen_base = ioremap_writethrough(external_addr,
                                                      external_len);
                 if (external_vgaiobase)
                         external_vgaiobase =
                           (unsigned long)ioremap(external_vgaiobase, 0x10000);
-                screen_base =
-                real_screen_base = external_addr;
+                screen_base = external_screen_base;
+                phys_screen_base = external_addr;
                 screen_len = external_len & PAGE_MASK;
                 memset (screen_base, 0, external_len);
         }
@@ -3235,8 +3238,8 @@ int __init atafb_init(void)
         if (register_framebuffer(&fb_info) < 0) {
 #ifdef ATAFB_EXT
                 if (external_addr) {
-                        iounmap(external_addr);
-                        external_addr = NULL;
+                        iounmap(external_screen_base);
+                        external_addr = 0;
                 }
                 if (external_vgaiobase) {
                         iounmap((void*)external_vgaiobase);