Merge branch 'warnings' of master.kernel.org:/pub/scm/linux/kernel/git/jgarzik/misc-2.6
[safe/jmp/linux-2.6] / drivers / video / ps3fb.c
index d6160e0..b3463dd 100644 (file)
@@ -54,6 +54,8 @@
 #define DDR_SIZE                               (0)     /* used no ddr */
 #define GPU_CMD_BUF_SIZE                       (64 * 1024)
 #define GPU_IOIF                               (0x0d000000UL)
+#define GPU_ALIGN_UP(x)                                _ALIGN_UP((x), 64)
+#define GPU_MAX_LINE_LENGTH                    (65536 - 64)
 
 #define PS3FB_FULL_MODE_BIT                    0x80
 
@@ -136,6 +138,11 @@ struct ps3fb_par {
        int mode_id, new_mode_id;
        int res_index;
        unsigned int num_frames;        /* num of frame buffers */
+       unsigned int width;
+       unsigned int height;
+       unsigned long full_offset;      /* start of fullscreen DDR fb */
+       unsigned long fb_offset;        /* start of actual DDR fb */
+       unsigned long pan_offset;
 };
 
 struct ps3fb_res_table {
@@ -291,15 +298,6 @@ static const struct fb_videomode ps3fb_modedb[] = {
 /* Start of the virtual frame buffer (relative to fullscreen ) */
 #define VP_OFF(i)      ((WIDTH(i) * Y_OFF(i) + X_OFF(i)) * BPP)
 
-/*
- * Start of the virtual frame buffer (relative to start of video memory)
- * This is PAGE_SIZE aligned for easier mmap()
- */
-#define VFB_OFF(i)     PAGE_ALIGN(VP_OFF(i))
-
-/* Start of the fullscreen frame buffer (relative to start of video memory) */
-#define FB_OFF(i)      (-VP_OFF(i) & ~PAGE_MASK)
-
 
 static int ps3fb_mode;
 module_param(ps3fb_mode, int, 0);
@@ -338,7 +336,7 @@ static int ps3fb_get_res_table(u32 xres, u32 yres, int mode)
 }
 
 static unsigned int ps3fb_find_mode(const struct fb_var_screeninfo *var,
-                                   u32 *line_length)
+                                   u32 *ddr_line_length, u32 *xdr_line_length)
 {
        unsigned int i, mode;
 
@@ -353,19 +351,30 @@ static unsigned int ps3fb_find_mode(const struct fb_var_screeninfo *var,
                    var->upper_margin == ps3fb_modedb[i].upper_margin &&
                    var->lower_margin == ps3fb_modedb[i].lower_margin &&
                    var->sync == ps3fb_modedb[i].sync &&
-                   (var->vmode & FB_VMODE_MASK) == ps3fb_modedb[i].vmode) {
-                       /* Cropped broadcast modes use the full line_length */
-                       *line_length =
-                           ps3fb_modedb[i < 10 ? i + 13 : i].xres * 4;
-                       /* Full broadcast modes have the full mode bit set */
-                       mode = i > 12 ? (i - 12) | PS3FB_FULL_MODE_BIT : i + 1;
-
-                       pr_debug("ps3fb_find_mode: mode %u\n", mode);
-                       return mode;
-               }
+                   (var->vmode & FB_VMODE_MASK) == ps3fb_modedb[i].vmode)
+                       goto found;
 
        pr_debug("ps3fb_find_mode: mode not found\n");
        return 0;
+
+found:
+       /* Cropped broadcast modes use the full line length */
+       *ddr_line_length = ps3fb_modedb[i < 10 ? i + 13 : i].xres * BPP;
+
+       if (ps3_compare_firmware_version(1, 9, 0) >= 0) {
+               *xdr_line_length = GPU_ALIGN_UP(max(var->xres,
+                                                   var->xres_virtual) * BPP);
+               if (*xdr_line_length > GPU_MAX_LINE_LENGTH)
+                       *xdr_line_length = GPU_MAX_LINE_LENGTH;
+       } else
+               *xdr_line_length = *ddr_line_length;
+
+       /* Full broadcast modes have the full mode bit set */
+       mode = i > 12 ? (i - 12) | PS3FB_FULL_MODE_BIT : i + 1;
+
+       pr_debug("ps3fb_find_mode: mode %u\n", mode);
+
+       return mode;
 }
 
 static const struct fb_videomode *ps3fb_default_mode(int id)
@@ -386,63 +395,78 @@ static const struct fb_videomode *ps3fb_default_mode(int id)
        return &ps3fb_modedb[mode - 1];
 }
 
-static int ps3fb_sync(struct fb_info *info, u32 frame)
+static void ps3fb_sync_image(struct device *dev, u64 frame_offset,
+                            u64 dst_offset, u64 src_offset, u32 width,
+                            u32 height, u32 dst_line_length,
+                            u32 src_line_length)
 {
-       struct ps3fb_par *par = info->par;
-       int i, status, error = 0;
-       u32 xres, yres;
-       u64 fb_ioif, offset;
-
-       acquire_console_sem();
-
-       i = par->res_index;
-       xres = ps3fb_res[i].xres;
-       yres = ps3fb_res[i].yres;
+       int status;
+       u64 line_length;
 
-       if (frame > par->num_frames - 1) {
-               dev_dbg(info->device, "%s: invalid frame number (%u)\n",
-                       __func__, frame);
-               error = -EINVAL;
-               goto out;
-       }
-       offset = xres * yres * BPP * frame;
+       line_length = dst_line_length;
+       if (src_line_length != dst_line_length)
+               line_length |= (u64)src_line_length << 32;
 
-       fb_ioif = GPU_IOIF + FB_OFF(i) + offset;
        status = lv1_gpu_context_attribute(ps3fb.context_handle,
                                           L1GPU_CONTEXT_ATTRIBUTE_FB_BLIT,
-                                          offset, fb_ioif,
+                                          dst_offset, GPU_IOIF + src_offset,
                                           L1GPU_FB_BLIT_WAIT_FOR_COMPLETION |
-                                          (xres << 16) | yres,
-                                          xres * BPP); /* line_length */
+                                          (width << 16) | height,
+                                          line_length);
        if (status)
-               dev_err(info->device,
+               dev_err(dev,
                        "%s: lv1_gpu_context_attribute FB_BLIT failed: %d\n",
                        __func__, status);
 #ifdef HEAD_A
        status = lv1_gpu_context_attribute(ps3fb.context_handle,
                                           L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_FLIP,
-                                          0, offset, 0, 0);
+                                          0, frame_offset, 0, 0);
        if (status)
-               dev_err(info->device,
-                       "%s: lv1_gpu_context_attribute FLIP failed: %d\n",
+               dev_err(dev, "%s: lv1_gpu_context_attribute FLIP failed: %d\n",
                        __func__, status);
 #endif
 #ifdef HEAD_B
        status = lv1_gpu_context_attribute(ps3fb.context_handle,
                                           L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_FLIP,
-                                          1, offset, 0, 0);
+                                          1, frame_offset, 0, 0);
        if (status)
-               dev_err(info->device,
-                       "%s: lv1_gpu_context_attribute FLIP failed: %d\n",
+               dev_err(dev, "%s: lv1_gpu_context_attribute FLIP failed: %d\n",
                        __func__, status);
 #endif
+}
+
+static int ps3fb_sync(struct fb_info *info, u32 frame)
+{
+       struct ps3fb_par *par = info->par;
+       int i, error = 0;
+       u32 ddr_line_length, xdr_line_length;
+       u64 ddr_base, xdr_base;
+
+       acquire_console_sem();
+
+       if (frame > par->num_frames - 1) {
+               dev_dbg(info->device, "%s: invalid frame number (%u)\n",
+                       __func__, frame);
+               error = -EINVAL;
+               goto out;
+       }
+
+       i = par->res_index;
+       xdr_line_length = info->fix.line_length;
+       ddr_line_length = ps3fb_res[i].xres * BPP;
+       xdr_base = frame * info->var.yres_virtual * xdr_line_length;
+       ddr_base = frame * ps3fb_res[i].yres * ddr_line_length;
+
+       ps3fb_sync_image(info->device, ddr_base + par->full_offset,
+                        ddr_base + par->fb_offset, xdr_base + par->pan_offset,
+                        par->width, par->height, ddr_line_length,
+                        xdr_line_length);
 
 out:
        release_console_sem();
        return error;
 }
 
-
 static int ps3fb_open(struct fb_info *info, int user)
 {
        atomic_inc(&ps3fb.f_count);
@@ -470,9 +494,8 @@ static int ps3fb_release(struct fb_info *info, int user)
 
 static int ps3fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
 {
-       u32 line_length;
+       u32 xdr_line_length, ddr_line_length;
        int mode;
-       int i;
 
        dev_dbg(info->device, "var->xres:%u info->var.xres:%u\n", var->xres,
                info->var.xres);
@@ -480,31 +503,27 @@ static int ps3fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
                info->var.yres);
 
        /* FIXME For now we do exact matches only */
-       mode = ps3fb_find_mode(var, &line_length);
+       mode = ps3fb_find_mode(var, &ddr_line_length, &xdr_line_length);
        if (!mode)
                return -EINVAL;
 
-       /*
-        *  FB_VMODE_CONUPDATE and FB_VMODE_SMOOTH_XPAN are equal!
-        *  as FB_VMODE_SMOOTH_XPAN is only used internally
-        */
-
-       if (var->vmode & FB_VMODE_CONUPDATE) {
-               var->vmode |= FB_VMODE_YWRAP;
-               var->xoffset = info->var.xoffset;
-               var->yoffset = info->var.yoffset;
-       }
+       /* Virtual screen */
+       if (var->xres_virtual < var->xres)
+               var->xres_virtual = var->xres;
+       if (var->yres_virtual < var->yres)
+               var->yres_virtual = var->yres;
 
-       /* Virtual screen and panning are not supported */
-       if (var->xres_virtual > var->xres || var->yres_virtual > var->yres ||
-           var->xoffset || var->yoffset) {
+       if (var->xres_virtual > xdr_line_length / BPP) {
                dev_dbg(info->device,
-                       "Virtual screen and panning are not supported\n");
+                       "Horizontal virtual screen size too large\n");
                return -EINVAL;
        }
 
-       var->xres_virtual = var->xres;
-       var->yres_virtual = var->yres;
+       if (var->xoffset + var->xres > var->xres_virtual ||
+           var->yoffset + var->yres > var->yres_virtual) {
+               dev_dbg(info->device, "panning out-of-range\n");
+               return -EINVAL;
+       }
 
        /* We support ARGB8888 only */
        if (var->bits_per_pixel > 32 || var->grayscale ||
@@ -539,9 +558,7 @@ static int ps3fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
        }
 
        /* Memory limit */
-       i = ps3fb_get_res_table(var->xres, var->yres, mode);
-       if (ps3fb_res[i].xres*ps3fb_res[i].yres*BPP >
-           ps3fb.xdr_size - VFB_OFF(i)) {
+       if (var->yres_virtual * xdr_line_length > ps3fb.xdr_size) {
                dev_dbg(info->device, "Not enough memory\n");
                return -ENOMEM;
        }
@@ -559,33 +576,45 @@ static int ps3fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
 static int ps3fb_set_par(struct fb_info *info)
 {
        struct ps3fb_par *par = info->par;
-       unsigned int mode;
+       unsigned int mode, ddr_line_length, xdr_line_length, lines, maxlines;
        int i;
        unsigned long offset;
+       u64 dst;
 
        dev_dbg(info->device, "xres:%d xv:%d yres:%d yv:%d clock:%d\n",
                info->var.xres, info->var.xres_virtual,
                info->var.yres, info->var.yres_virtual, info->var.pixclock);
 
-       mode = ps3fb_find_mode(&info->var, &info->fix.line_length);
+       mode = ps3fb_find_mode(&info->var, &ddr_line_length, &xdr_line_length);
        if (!mode)
                return -EINVAL;
 
        i = ps3fb_get_res_table(info->var.xres, info->var.yres, mode);
        par->res_index = i;
 
-       offset = VFB_OFF(i);
-       info->fix.smem_start = virt_to_abs(ps3fb.xdr_ea) + offset;
-       info->fix.smem_len = ps3fb.xdr_size - offset;
-       info->screen_base = (char __iomem *)ps3fb.xdr_ea + offset;
-       memset(ps3fb.xdr_ea, 0, ps3fb.xdr_size);
+       info->fix.smem_start = virt_to_abs(ps3fb.xdr_ea);
+       info->fix.smem_len = ps3fb.xdr_size;
+       info->fix.xpanstep = info->var.xres_virtual > info->var.xres ? 1 : 0;
+       info->fix.ypanstep = info->var.yres_virtual > info->var.yres ? 1 : 0;
+       info->fix.line_length = xdr_line_length;
 
-       par->num_frames = info->fix.smem_len/
-                         (ps3fb_res[i].xres*ps3fb_res[i].yres*BPP);
+       info->screen_base = (char __iomem *)ps3fb.xdr_ea;
+
+       par->num_frames = ps3fb.xdr_size /
+                         max(ps3fb_res[i].yres * ddr_line_length,
+                             info->var.yres_virtual * xdr_line_length);
 
        /* Keep the special bits we cannot set using fb_var_screeninfo */
        par->new_mode_id = (par->new_mode_id & ~PS3AV_MODE_MASK) | mode;
 
+       par->width = info->var.xres;
+       par->height = info->var.yres;
+       offset = VP_OFF(i);
+       par->fb_offset = GPU_ALIGN_UP(offset);
+       par->full_offset = par->fb_offset - offset;
+       par->pan_offset = info->var.yoffset * xdr_line_length +
+                         info->var.xoffset * BPP;
+
        if (par->new_mode_id != par->mode_id) {
                if (ps3av_set_video_mode(par->new_mode_id)) {
                        par->new_mode_id = par->mode_id;
@@ -594,6 +623,21 @@ static int ps3fb_set_par(struct fb_info *info)
                par->mode_id = par->new_mode_id;
        }
 
+       /* Clear XDR frame buffer memory */
+       memset(ps3fb.xdr_ea, 0, ps3fb.xdr_size);
+
+       /* Clear DDR frame buffer memory */
+       lines = ps3fb_res[i].yres * par->num_frames;
+       if (par->full_offset)
+               lines++;
+       maxlines = ps3fb.xdr_size / ddr_line_length;
+       for (dst = 0; lines; dst += maxlines * ddr_line_length) {
+               unsigned int l = min(lines, maxlines);
+               ps3fb_sync_image(info->device, 0, dst, 0, ps3fb_res[i].xres, l,
+                                ddr_line_length, ddr_line_length);
+               lines -= l;
+       }
+
        return 0;
 }
 
@@ -620,6 +664,16 @@ static int ps3fb_setcolreg(unsigned int regno, unsigned int red,
        return 0;
 }
 
+static int ps3fb_pan_display(struct fb_var_screeninfo *var,
+                            struct fb_info *info)
+{
+       struct ps3fb_par *par = info->par;
+
+       par->pan_offset = var->yoffset * info->fix.line_length +
+                         var->xoffset * BPP;
+       return 0;
+}
+
     /*
      *  As we have a virtual frame buffer, we need our own mmap function
      */
@@ -782,12 +836,11 @@ static int ps3fb_ioctl(struct fb_info *info, unsigned int cmd,
                {
                        struct ps3fb_par *par = info->par;
                        struct ps3fb_ioctl_res res;
-                       int i = par->res_index;
                        dev_dbg(info->device, "PS3FB_IOCTL_SCREENINFO:\n");
-                       res.xres = ps3fb_res[i].xres;
-                       res.yres = ps3fb_res[i].yres;
-                       res.xoff = ps3fb_res[i].xoff;
-                       res.yoff = ps3fb_res[i].yoff;
+                       res.xres = info->fix.line_length / BPP;
+                       res.yres = info->var.yres_virtual;
+                       res.xoff = (res.xres - info->var.xres) / 2;
+                       res.yoff = (res.yres - info->var.yres) / 2;
                        res.num_frames = par->num_frames;
                        if (!copy_to_user(argp, &res, sizeof(res)))
                                retval = 0;
@@ -944,6 +997,7 @@ static struct fb_ops ps3fb_ops = {
        .fb_check_var   = ps3fb_check_var,
        .fb_set_par     = ps3fb_set_par,
        .fb_setcolreg   = ps3fb_setcolreg,
+       .fb_pan_display = ps3fb_pan_display,
        .fb_fillrect    = sys_fillrect,
        .fb_copyarea    = sys_copyarea,
        .fb_imageblit   = sys_imageblit,
@@ -1005,7 +1059,6 @@ static int __devinit ps3fb_probe(struct ps3_system_bus_device *dev)
        u64 lpar_reports_size = 0;
        u64 xdr_lpar;
        int status, res_index;
-       unsigned long offset;
        struct task_struct *task;
 
        status = ps3_open_hv_device(dev);
@@ -1088,15 +1141,15 @@ static int __devinit ps3fb_probe(struct ps3_system_bus_device *dev)
        par->res_index = res_index;
        par->num_frames = 1;
 
-       offset = VFB_OFF(res_index);
-       info->screen_base = (char __iomem *)ps3fb.xdr_ea + offset;
+       info->screen_base = (char __iomem *)ps3fb.xdr_ea;
        info->fbops = &ps3fb_ops;
 
        info->fix = ps3fb_fix;
-       info->fix.smem_start = virt_to_abs(ps3fb.xdr_ea) + offset;
-       info->fix.smem_len = ps3fb.xdr_size - offset;
+       info->fix.smem_start = virt_to_abs(ps3fb.xdr_ea);
+       info->fix.smem_len = ps3fb.xdr_size;
        info->pseudo_palette = par->pseudo_palette;
-       info->flags = FBINFO_DEFAULT | FBINFO_READS_FAST;
+       info->flags = FBINFO_DEFAULT | FBINFO_READS_FAST |
+                     FBINFO_HWACCEL_XPAN | FBINFO_HWACCEL_YPAN;
 
        retval = fb_alloc_cmap(&info->cmap, 256, 0);
        if (retval < 0)