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