linux/drivers/video/fbdev/omap2/vrfb.c
<<
>>
Prefs
   1/*
   2 * VRFB Rotation Engine
   3 *
   4 * Copyright (C) 2009 Nokia Corporation
   5 * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
   6 *
   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.
  10 *
  11 * This program is distributed in the hope that it will be useful, but
  12 * WITHOUT ANY WARRANTY; without even the implied warranty of
  13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14 * General Public License for more details.
  15 *
  16 * You should have received a copy of the GNU General Public License along
  17 * with this program; if not, write to the Free Software Foundation, Inc.,
  18 * 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
  19 */
  20
  21/*#define DEBUG*/
  22
  23#include <linux/err.h>
  24#include <linux/kernel.h>
  25#include <linux/module.h>
  26#include <linux/ioport.h>
  27#include <linux/io.h>
  28#include <linux/bitops.h>
  29#include <linux/mutex.h>
  30#include <linux/platform_device.h>
  31
  32#include <video/omapvrfb.h>
  33
  34#ifdef DEBUG
  35#define DBG(format, ...) pr_debug("VRFB: " format, ## __VA_ARGS__)
  36#else
  37#define DBG(format, ...)
  38#endif
  39
  40#define SMS_ROT_CONTROL(context)        (0x0 + 0x10 * context)
  41#define SMS_ROT_SIZE(context)           (0x4 + 0x10 * context)
  42#define SMS_ROT_PHYSICAL_BA(context)    (0x8 + 0x10 * context)
  43#define SMS_ROT_VIRT_BASE(rot)          (0x1000000 * (rot))
  44
  45#define OMAP_VRFB_SIZE                  (2048 * 2048 * 4)
  46
  47#define VRFB_PAGE_WIDTH_EXP     5 /* Assuming SDRAM pagesize= 1024 */
  48#define VRFB_PAGE_HEIGHT_EXP    5 /* 1024 = 2^5 * 2^5 */
  49#define VRFB_PAGE_WIDTH         (1 << VRFB_PAGE_WIDTH_EXP)
  50#define VRFB_PAGE_HEIGHT        (1 << VRFB_PAGE_HEIGHT_EXP)
  51#define SMS_IMAGEHEIGHT_OFFSET  16
  52#define SMS_IMAGEWIDTH_OFFSET   0
  53#define SMS_PH_OFFSET           8
  54#define SMS_PW_OFFSET           4
  55#define SMS_PS_OFFSET           0
  56
  57/* bitmap of reserved contexts */
  58static unsigned long ctx_map;
  59
  60struct vrfb_ctx {
  61        u32 base;
  62        u32 physical_ba;
  63        u32 control;
  64        u32 size;
  65};
  66
  67static DEFINE_MUTEX(ctx_lock);
  68
  69/*
  70 * Access to this happens from client drivers or the PM core after wake-up.
  71 * For the first case we require locking at the driver level, for the second
  72 * we don't need locking, since no drivers will run until after the wake-up
  73 * has finished.
  74 */
  75
  76static void __iomem *vrfb_base;
  77
  78static int num_ctxs;
  79static struct vrfb_ctx *ctxs;
  80
  81static bool vrfb_loaded;
  82
  83static void omap2_sms_write_rot_control(u32 val, unsigned ctx)
  84{
  85        __raw_writel(val, vrfb_base + SMS_ROT_CONTROL(ctx));
  86}
  87
  88static void omap2_sms_write_rot_size(u32 val, unsigned ctx)
  89{
  90        __raw_writel(val, vrfb_base + SMS_ROT_SIZE(ctx));
  91}
  92
  93static void omap2_sms_write_rot_physical_ba(u32 val, unsigned ctx)
  94{
  95        __raw_writel(val, vrfb_base + SMS_ROT_PHYSICAL_BA(ctx));
  96}
  97
  98static inline void restore_hw_context(int ctx)
  99{
 100        omap2_sms_write_rot_control(ctxs[ctx].control, ctx);
 101        omap2_sms_write_rot_size(ctxs[ctx].size, ctx);
 102        omap2_sms_write_rot_physical_ba(ctxs[ctx].physical_ba, ctx);
 103}
 104
 105static u32 get_image_width_roundup(u16 width, u8 bytespp)
 106{
 107        unsigned long stride = width * bytespp;
 108        unsigned long ceil_pages_per_stride = (stride / VRFB_PAGE_WIDTH) +
 109                (stride % VRFB_PAGE_WIDTH != 0);
 110
 111        return ceil_pages_per_stride * VRFB_PAGE_WIDTH / bytespp;
 112}
 113
 114/*
 115 * This the extra space needed in the VRFB physical area for VRFB to safely wrap
 116 * any memory accesses to the invisible part of the virtual view to the physical
 117 * area.
 118 */
 119static inline u32 get_extra_physical_size(u16 image_width_roundup, u8 bytespp)
 120{
 121        return (OMAP_VRFB_LINE_LEN - image_width_roundup) * VRFB_PAGE_HEIGHT *
 122                bytespp;
 123}
 124
 125void omap_vrfb_restore_context(void)
 126{
 127        int i;
 128        unsigned long map = ctx_map;
 129
 130        for (i = ffs(map); i; i = ffs(map)) {
 131                /* i=1..32 */
 132                i--;
 133                map &= ~(1 << i);
 134                restore_hw_context(i);
 135        }
 136}
 137
 138void omap_vrfb_adjust_size(u16 *width, u16 *height,
 139                u8 bytespp)
 140{
 141        *width = ALIGN(*width * bytespp, VRFB_PAGE_WIDTH) / bytespp;
 142        *height = ALIGN(*height, VRFB_PAGE_HEIGHT);
 143}
 144EXPORT_SYMBOL(omap_vrfb_adjust_size);
 145
 146u32 omap_vrfb_min_phys_size(u16 width, u16 height, u8 bytespp)
 147{
 148        unsigned long image_width_roundup = get_image_width_roundup(width,
 149                bytespp);
 150
 151        if (image_width_roundup > OMAP_VRFB_LINE_LEN)
 152                return 0;
 153
 154        return (width * height * bytespp) + get_extra_physical_size(
 155                image_width_roundup, bytespp);
 156}
 157EXPORT_SYMBOL(omap_vrfb_min_phys_size);
 158
 159u16 omap_vrfb_max_height(u32 phys_size, u16 width, u8 bytespp)
 160{
 161        unsigned long image_width_roundup = get_image_width_roundup(width,
 162                bytespp);
 163        unsigned long height;
 164        unsigned long extra;
 165
 166        if (image_width_roundup > OMAP_VRFB_LINE_LEN)
 167                return 0;
 168
 169        extra = get_extra_physical_size(image_width_roundup, bytespp);
 170
 171        if (phys_size < extra)
 172                return 0;
 173
 174        height = (phys_size - extra) / (width * bytespp);
 175
 176        /* Virtual views provided by VRFB are limited to 2048x2048. */
 177        return min_t(unsigned long, height, 2048);
 178}
 179EXPORT_SYMBOL(omap_vrfb_max_height);
 180
 181void omap_vrfb_setup(struct vrfb *vrfb, unsigned long paddr,
 182                u16 width, u16 height,
 183                unsigned bytespp, bool yuv_mode)
 184{
 185        unsigned pixel_size_exp;
 186        u16 vrfb_width;
 187        u16 vrfb_height;
 188        u8 ctx = vrfb->context;
 189        u32 size;
 190        u32 control;
 191
 192        DBG("omapfb_set_vrfb(%d, %lx, %dx%d, %d, %d)\n", ctx, paddr,
 193                        width, height, bytespp, yuv_mode);
 194
 195        /* For YUV2 and UYVY modes VRFB needs to handle pixels a bit
 196         * differently. See TRM. */
 197        if (yuv_mode) {
 198                bytespp *= 2;
 199                width /= 2;
 200        }
 201
 202        if (bytespp == 4)
 203                pixel_size_exp = 2;
 204        else if (bytespp == 2)
 205                pixel_size_exp = 1;
 206        else {
 207                BUG();
 208                return;
 209        }
 210
 211        vrfb_width = ALIGN(width * bytespp, VRFB_PAGE_WIDTH) / bytespp;
 212        vrfb_height = ALIGN(height, VRFB_PAGE_HEIGHT);
 213
 214        DBG("vrfb w %u, h %u bytespp %d\n", vrfb_width, vrfb_height, bytespp);
 215
 216        size  = vrfb_width << SMS_IMAGEWIDTH_OFFSET;
 217        size |= vrfb_height << SMS_IMAGEHEIGHT_OFFSET;
 218
 219        control  = pixel_size_exp << SMS_PS_OFFSET;
 220        control |= VRFB_PAGE_WIDTH_EXP  << SMS_PW_OFFSET;
 221        control |= VRFB_PAGE_HEIGHT_EXP << SMS_PH_OFFSET;
 222
 223        ctxs[ctx].physical_ba = paddr;
 224        ctxs[ctx].size = size;
 225        ctxs[ctx].control = control;
 226
 227        omap2_sms_write_rot_physical_ba(paddr, ctx);
 228        omap2_sms_write_rot_size(size, ctx);
 229        omap2_sms_write_rot_control(control, ctx);
 230
 231        DBG("vrfb offset pixels %d, %d\n",
 232                        vrfb_width - width, vrfb_height - height);
 233
 234        vrfb->xres = width;
 235        vrfb->yres = height;
 236        vrfb->xoffset = vrfb_width - width;
 237        vrfb->yoffset = vrfb_height - height;
 238        vrfb->bytespp = bytespp;
 239        vrfb->yuv_mode = yuv_mode;
 240}
 241EXPORT_SYMBOL(omap_vrfb_setup);
 242
 243int omap_vrfb_map_angle(struct vrfb *vrfb, u16 height, u8 rot)
 244{
 245        unsigned long size = height * OMAP_VRFB_LINE_LEN * vrfb->bytespp;
 246
 247        vrfb->vaddr[rot] = ioremap_wc(vrfb->paddr[rot], size);
 248
 249        if (!vrfb->vaddr[rot]) {
 250                printk(KERN_ERR "vrfb: ioremap failed\n");
 251                return -ENOMEM;
 252        }
 253
 254        DBG("ioremapped vrfb area %d of size %lu into %p\n", rot, size,
 255                vrfb->vaddr[rot]);
 256
 257        return 0;
 258}
 259EXPORT_SYMBOL(omap_vrfb_map_angle);
 260
 261void omap_vrfb_release_ctx(struct vrfb *vrfb)
 262{
 263        int rot;
 264        int ctx = vrfb->context;
 265
 266        if (ctx == 0xff)
 267                return;
 268
 269        DBG("release ctx %d\n", ctx);
 270
 271        mutex_lock(&ctx_lock);
 272
 273        BUG_ON(!(ctx_map & (1 << ctx)));
 274
 275        clear_bit(ctx, &ctx_map);
 276
 277        for (rot = 0; rot < 4; ++rot) {
 278                if (vrfb->paddr[rot]) {
 279                        release_mem_region(vrfb->paddr[rot], OMAP_VRFB_SIZE);
 280                        vrfb->paddr[rot] = 0;
 281                }
 282        }
 283
 284        vrfb->context = 0xff;
 285
 286        mutex_unlock(&ctx_lock);
 287}
 288EXPORT_SYMBOL(omap_vrfb_release_ctx);
 289
 290int omap_vrfb_request_ctx(struct vrfb *vrfb)
 291{
 292        int rot;
 293        u32 paddr;
 294        u8 ctx;
 295        int r;
 296
 297        DBG("request ctx\n");
 298
 299        mutex_lock(&ctx_lock);
 300
 301        for (ctx = 0; ctx < num_ctxs; ++ctx)
 302                if ((ctx_map & (1 << ctx)) == 0)
 303                        break;
 304
 305        if (ctx == num_ctxs) {
 306                pr_err("vrfb: no free contexts\n");
 307                r = -EBUSY;
 308                goto out;
 309        }
 310
 311        DBG("found free ctx %d\n", ctx);
 312
 313        set_bit(ctx, &ctx_map);
 314
 315        memset(vrfb, 0, sizeof(*vrfb));
 316
 317        vrfb->context = ctx;
 318
 319        for (rot = 0; rot < 4; ++rot) {
 320                paddr = ctxs[ctx].base + SMS_ROT_VIRT_BASE(rot);
 321                if (!request_mem_region(paddr, OMAP_VRFB_SIZE, "vrfb")) {
 322                        pr_err("vrfb: failed to reserve VRFB "
 323                                        "area for ctx %d, rotation %d\n",
 324                                        ctx, rot * 90);
 325                        omap_vrfb_release_ctx(vrfb);
 326                        r = -ENOMEM;
 327                        goto out;
 328                }
 329
 330                vrfb->paddr[rot] = paddr;
 331
 332                DBG("VRFB %d/%d: %lx\n", ctx, rot*90, vrfb->paddr[rot]);
 333        }
 334
 335        r = 0;
 336out:
 337        mutex_unlock(&ctx_lock);
 338        return r;
 339}
 340EXPORT_SYMBOL(omap_vrfb_request_ctx);
 341
 342bool omap_vrfb_supported(void)
 343{
 344        return vrfb_loaded;
 345}
 346EXPORT_SYMBOL(omap_vrfb_supported);
 347
 348static int __init vrfb_probe(struct platform_device *pdev)
 349{
 350        struct resource *mem;
 351        int i;
 352
 353        /* first resource is the register res, the rest are vrfb contexts */
 354
 355        mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 356        vrfb_base = devm_ioremap_resource(&pdev->dev, mem);
 357        if (IS_ERR(vrfb_base))
 358                return PTR_ERR(vrfb_base);
 359
 360        num_ctxs = pdev->num_resources - 1;
 361
 362        ctxs = devm_kzalloc(&pdev->dev,
 363                        sizeof(struct vrfb_ctx) * num_ctxs,
 364                        GFP_KERNEL);
 365
 366        if (!ctxs)
 367                return -ENOMEM;
 368
 369        for (i = 0; i < num_ctxs; ++i) {
 370                mem = platform_get_resource(pdev, IORESOURCE_MEM, 1 + i);
 371                if (!mem) {
 372                        dev_err(&pdev->dev, "can't get vrfb ctx %d address\n",
 373                                        i);
 374                        return -EINVAL;
 375                }
 376
 377                ctxs[i].base = mem->start;
 378        }
 379
 380        vrfb_loaded = true;
 381
 382        return 0;
 383}
 384
 385static void __exit vrfb_remove(struct platform_device *pdev)
 386{
 387        vrfb_loaded = false;
 388}
 389
 390static struct platform_driver vrfb_driver = {
 391        .driver.name    = "omapvrfb",
 392        .remove         = __exit_p(vrfb_remove),
 393};
 394
 395module_platform_driver_probe(vrfb_driver, vrfb_probe);
 396
 397MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@ti.com>");
 398MODULE_DESCRIPTION("OMAP VRFB");
 399MODULE_LICENSE("GPL v2");
 400
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.