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/kernel.h> 24#include <linux/module.h> 25#include <linux/ioport.h> 26#include <linux/io.h> 27#include <linux/bitops.h> 28#include <linux/mutex.h> 29 30#include <mach/io.h> 31#include <plat/vrfb.h> 32#include <plat/sdrc.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_VIRT_BASE(context, rot) \ 41 (((context >= 4) ? 0xD0000000 : 0x70000000) \ 42 + (0x4000000 * (context)) \ 43 + (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#define VRFB_NUM_CTXS 12 58/* bitmap of reserved contexts */ 59static unsigned long ctx_map; 60 61static DEFINE_MUTEX(ctx_lock); 62 63/* 64 * Access to this happens from client drivers or the PM core after wake-up. 65 * For the first case we require locking at the driver level, for the second 66 * we don't need locking, since no drivers will run until after the wake-up 67 * has finished. 68 */ 69static struct { 70 u32 physical_ba; 71 u32 control; 72 u32 size; 73} vrfb_hw_context[VRFB_NUM_CTXS]; 74 75static inline void restore_hw_context(int ctx) 76{ 77 omap2_sms_write_rot_control(vrfb_hw_context[ctx].control, ctx); 78 omap2_sms_write_rot_size(vrfb_hw_context[ctx].size, ctx); 79 omap2_sms_write_rot_physical_ba(vrfb_hw_context[ctx].physical_ba, ctx); 80} 81 82static u32 get_image_width_roundup(u16 width, u8 bytespp) 83{ 84 unsigned long stride = width * bytespp; 85 unsigned long ceil_pages_per_stride = (stride / VRFB_PAGE_WIDTH) + 86 (stride % VRFB_PAGE_WIDTH != 0); 87 88 return ceil_pages_per_stride * VRFB_PAGE_WIDTH / bytespp; 89} 90 91/* 92 * This the extra space needed in the VRFB physical area for VRFB to safely wrap 93 * any memory accesses to the invisible part of the virtual view to the physical 94 * area. 95 */ 96static inline u32 get_extra_physical_size(u16 image_width_roundup, u8 bytespp) 97{ 98 return (OMAP_VRFB_LINE_LEN - image_width_roundup) * VRFB_PAGE_HEIGHT * 99 bytespp; 100} 101 102void omap_vrfb_restore_context(void) 103{ 104 int i; 105 unsigned long map = ctx_map; 106 107 for (i = ffs(map); i; i = ffs(map)) { 108 /* i=1..32 */ 109 i--; 110 map &= ~(1 << i); 111 restore_hw_context(i); 112 } 113} 114 115void omap_vrfb_adjust_size(u16 *width, u16 *height, 116 u8 bytespp) 117{ 118 *width = ALIGN(*width * bytespp, VRFB_PAGE_WIDTH) / bytespp; 119 *height = ALIGN(*height, VRFB_PAGE_HEIGHT); 120} 121EXPORT_SYMBOL(omap_vrfb_adjust_size); 122 123u32 omap_vrfb_min_phys_size(u16 width, u16 height, u8 bytespp) 124{ 125 unsigned long image_width_roundup = get_image_width_roundup(width, 126 bytespp); 127 128 if (image_width_roundup > OMAP_VRFB_LINE_LEN) 129 return 0; 130 131 return (width * height * bytespp) + get_extra_physical_size( 132 image_width_roundup, bytespp); 133} 134EXPORT_SYMBOL(omap_vrfb_min_phys_size); 135 136u16 omap_vrfb_max_height(u32 phys_size, u16 width, u8 bytespp) 137{ 138 unsigned long image_width_roundup = get_image_width_roundup(width, 139 bytespp); 140 unsigned long height; 141 unsigned long extra; 142 143 if (image_width_roundup > OMAP_VRFB_LINE_LEN) 144 return 0; 145 146 extra = get_extra_physical_size(image_width_roundup, bytespp); 147 148 if (phys_size < extra) 149 return 0; 150 151 height = (phys_size - extra) / (width * bytespp); 152 153 /* Virtual views provided by VRFB are limited to 2048x2048. */ 154 return min_t(unsigned long, height, 2048); 155} 156EXPORT_SYMBOL(omap_vrfb_max_height); 157 158void omap_vrfb_setup(struct vrfb *vrfb, unsigned long paddr, 159 u16 width, u16 height, 160 unsigned bytespp, bool yuv_mode) 161{ 162 unsigned pixel_size_exp; 163 u16 vrfb_width; 164 u16 vrfb_height; 165 u8 ctx = vrfb->context; 166 u32 size; 167 u32 control; 168 169 DBG("omapfb_set_vrfb(%d, %lx, %dx%d, %d, %d)\n", ctx, paddr, 170 width, height, bytespp, yuv_mode); 171 172 /* For YUV2 and UYVY modes VRFB needs to handle pixels a bit 173 * differently. See TRM. */ 174 if (yuv_mode) { 175 bytespp *= 2; 176 width /= 2; 177 } 178 179 if (bytespp == 4) 180 pixel_size_exp = 2; 181 else if (bytespp == 2) 182 pixel_size_exp = 1; 183 else 184 BUG(); 185 186 vrfb_width = ALIGN(width * bytespp, VRFB_PAGE_WIDTH) / bytespp; 187 vrfb_height = ALIGN(height, VRFB_PAGE_HEIGHT); 188 189 DBG("vrfb w %u, h %u bytespp %d\n", vrfb_width, vrfb_height, bytespp); 190 191 size = vrfb_width << SMS_IMAGEWIDTH_OFFSET; 192 size |= vrfb_height << SMS_IMAGEHEIGHT_OFFSET; 193 194 control = pixel_size_exp << SMS_PS_OFFSET; 195 control |= VRFB_PAGE_WIDTH_EXP << SMS_PW_OFFSET; 196 control |= VRFB_PAGE_HEIGHT_EXP << SMS_PH_OFFSET; 197 198 vrfb_hw_context[ctx].physical_ba = paddr; 199 vrfb_hw_context[ctx].size = size; 200 vrfb_hw_context[ctx].control = control; 201 202 omap2_sms_write_rot_physical_ba(paddr, ctx); 203 omap2_sms_write_rot_size(size, ctx); 204 omap2_sms_write_rot_control(control, ctx); 205 206 DBG("vrfb offset pixels %d, %d\n", 207 vrfb_width - width, vrfb_height - height); 208 209 vrfb->xres = width; 210 vrfb->yres = height; 211 vrfb->xoffset = vrfb_width - width; 212 vrfb->yoffset = vrfb_height - height; 213 vrfb->bytespp = bytespp; 214 vrfb->yuv_mode = yuv_mode; 215} 216EXPORT_SYMBOL(omap_vrfb_setup); 217 218int omap_vrfb_map_angle(struct vrfb *vrfb, u16 height, u8 rot) 219{ 220 unsigned long size = height * OMAP_VRFB_LINE_LEN * vrfb->bytespp; 221 222 vrfb->vaddr[rot] = ioremap_wc(vrfb->paddr[rot], size); 223 224 if (!vrfb->vaddr[rot]) { 225 printk(KERN_ERR "vrfb: ioremap failed\n"); 226 return -ENOMEM; 227 } 228 229 DBG("ioremapped vrfb area %d of size %lu into %p\n", rot, size, 230 vrfb->vaddr[rot]); 231 232 return 0; 233} 234EXPORT_SYMBOL(omap_vrfb_map_angle); 235 236void omap_vrfb_release_ctx(struct vrfb *vrfb) 237{ 238 int rot; 239 int ctx = vrfb->context; 240 241 if (ctx == 0xff) 242 return; 243 244 DBG("release ctx %d\n", ctx); 245 246 mutex_lock(&ctx_lock); 247 248 BUG_ON(!(ctx_map & (1 << ctx))); 249 250 clear_bit(ctx, &ctx_map); 251 252 for (rot = 0; rot < 4; ++rot) { 253 if (vrfb->paddr[rot]) { 254 release_mem_region(vrfb->paddr[rot], OMAP_VRFB_SIZE); 255 vrfb->paddr[rot] = 0; 256 } 257 } 258 259 vrfb->context = 0xff; 260 261 mutex_unlock(&ctx_lock); 262} 263EXPORT_SYMBOL(omap_vrfb_release_ctx); 264 265int omap_vrfb_request_ctx(struct vrfb *vrfb) 266{ 267 int rot; 268 u32 paddr; 269 u8 ctx; 270 int r; 271 272 DBG("request ctx\n"); 273 274 mutex_lock(&ctx_lock); 275 276 for (ctx = 0; ctx < VRFB_NUM_CTXS; ++ctx) 277 if ((ctx_map & (1 << ctx)) == 0) 278 break; 279 280 if (ctx == VRFB_NUM_CTXS) { 281 pr_err("vrfb: no free contexts\n"); 282 r = -EBUSY; 283 goto out; 284 } 285 286 DBG("found free ctx %d\n", ctx); 287 288 set_bit(ctx, &ctx_map); 289 290 memset(vrfb, 0, sizeof(*vrfb)); 291 292 vrfb->context = ctx; 293 294 for (rot = 0; rot < 4; ++rot) { 295 paddr = SMS_ROT_VIRT_BASE(ctx, rot); 296 if (!request_mem_region(paddr, OMAP_VRFB_SIZE, "vrfb")) { 297 pr_err("vrfb: failed to reserve VRFB " 298 "area for ctx %d, rotation %d\n", 299 ctx, rot * 90); 300 omap_vrfb_release_ctx(vrfb); 301 r = -ENOMEM; 302 goto out; 303 } 304 305 vrfb->paddr[rot] = paddr; 306 307 DBG("VRFB %d/%d: %lx\n", ctx, rot*90, vrfb->paddr[rot]); 308 } 309 310 r = 0; 311out: 312 mutex_unlock(&ctx_lock); 313 return r; 314} 315EXPORT_SYMBOL(omap_vrfb_request_ctx); 316