1
2
3
4
5
6
7
8
9
10
11#include <linux/console.h>
12#include <linux/delay.h>
13#include <linux/errno.h>
14#include <linux/init.h>
15#include <linux/kernel.h>
16#include <linux/mm.h>
17#include <linux/module.h>
18#include <linux/slab.h>
19#include <linux/string.h>
20#include <linux/tty.h>
21
22#include <drm/drm.h>
23#include <drm/drm_crtc.h>
24#include <drm/drm_fb_helper.h>
25#include <drm/drm_fourcc.h>
26
27#include "psb_drv.h"
28#include "psb_reg.h"
29
30
31
32
33
34
35
36
37
38void psb_spank(struct drm_psb_private *dev_priv)
39{
40 PSB_WSGX32(_PSB_CS_RESET_BIF_RESET | _PSB_CS_RESET_DPM_RESET |
41 _PSB_CS_RESET_TA_RESET | _PSB_CS_RESET_USE_RESET |
42 _PSB_CS_RESET_ISP_RESET | _PSB_CS_RESET_TSP_RESET |
43 _PSB_CS_RESET_TWOD_RESET, PSB_CR_SOFT_RESET);
44 PSB_RSGX32(PSB_CR_SOFT_RESET);
45
46 msleep(1);
47
48 PSB_WSGX32(0, PSB_CR_SOFT_RESET);
49 wmb();
50 PSB_WSGX32(PSB_RSGX32(PSB_CR_BIF_CTRL) | _PSB_CB_CTRL_CLEAR_FAULT,
51 PSB_CR_BIF_CTRL);
52 wmb();
53 (void) PSB_RSGX32(PSB_CR_BIF_CTRL);
54
55 msleep(1);
56 PSB_WSGX32(PSB_RSGX32(PSB_CR_BIF_CTRL) & ~_PSB_CB_CTRL_CLEAR_FAULT,
57 PSB_CR_BIF_CTRL);
58 (void) PSB_RSGX32(PSB_CR_BIF_CTRL);
59 PSB_WSGX32(dev_priv->gtt.gatt_start, PSB_CR_BIF_TWOD_REQ_BASE);
60}
61
62
63
64
65
66
67
68
69
70static int psb_2d_wait_available(struct drm_psb_private *dev_priv,
71 unsigned size)
72{
73 uint32_t avail = PSB_RSGX32(PSB_CR_2D_SOCIF);
74 unsigned long t = jiffies + HZ;
75
76 while (avail < size) {
77 avail = PSB_RSGX32(PSB_CR_2D_SOCIF);
78 if (time_after(jiffies, t)) {
79 psb_spank(dev_priv);
80 return -EIO;
81 }
82 }
83 return 0;
84}
85
86
87
88
89
90
91
92
93
94
95static int psbfb_2d_submit(struct drm_psb_private *dev_priv, uint32_t *cmdbuf,
96 unsigned size)
97{
98 int ret = 0;
99 int i;
100 unsigned submit_size;
101 unsigned long flags;
102
103 spin_lock_irqsave(&dev_priv->lock_2d, flags);
104 while (size > 0) {
105 submit_size = (size < 0x60) ? size : 0x60;
106 size -= submit_size;
107 ret = psb_2d_wait_available(dev_priv, submit_size);
108 if (ret)
109 break;
110
111 submit_size <<= 2;
112
113 for (i = 0; i < submit_size; i += 4)
114 PSB_WSGX32(*cmdbuf++, PSB_SGX_2D_SLAVE_PORT + i);
115
116 (void)PSB_RSGX32(PSB_SGX_2D_SLAVE_PORT + i - 4);
117 }
118 spin_unlock_irqrestore(&dev_priv->lock_2d, flags);
119 return ret;
120}
121
122
123
124
125
126
127
128
129
130
131static u32 psb_accel_2d_copy_direction(int xdir, int ydir)
132{
133 if (xdir < 0)
134 return (ydir < 0) ? PSB_2D_COPYORDER_BR2TL :
135 PSB_2D_COPYORDER_TR2BL;
136 else
137 return (ydir < 0) ? PSB_2D_COPYORDER_BL2TR :
138 PSB_2D_COPYORDER_TL2BR;
139}
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159static int psb_accel_2d_copy(struct drm_psb_private *dev_priv,
160 uint32_t src_offset, uint32_t src_stride,
161 uint32_t src_format, uint32_t dst_offset,
162 uint32_t dst_stride, uint32_t dst_format,
163 uint16_t src_x, uint16_t src_y,
164 uint16_t dst_x, uint16_t dst_y,
165 uint16_t size_x, uint16_t size_y)
166{
167 uint32_t blit_cmd;
168 uint32_t buffer[10];
169 uint32_t *buf;
170 uint32_t direction;
171
172 buf = buffer;
173
174 direction =
175 psb_accel_2d_copy_direction(src_x - dst_x, src_y - dst_y);
176
177 if (direction == PSB_2D_COPYORDER_BR2TL ||
178 direction == PSB_2D_COPYORDER_TR2BL) {
179 src_x += size_x - 1;
180 dst_x += size_x - 1;
181 }
182 if (direction == PSB_2D_COPYORDER_BR2TL ||
183 direction == PSB_2D_COPYORDER_BL2TR) {
184 src_y += size_y - 1;
185 dst_y += size_y - 1;
186 }
187
188 blit_cmd =
189 PSB_2D_BLIT_BH |
190 PSB_2D_ROT_NONE |
191 PSB_2D_DSTCK_DISABLE |
192 PSB_2D_SRCCK_DISABLE |
193 PSB_2D_USE_PAT | PSB_2D_ROP3_SRCCOPY | direction;
194
195 *buf++ = PSB_2D_FENCE_BH;
196 *buf++ =
197 PSB_2D_DST_SURF_BH | dst_format | (dst_stride <<
198 PSB_2D_DST_STRIDE_SHIFT);
199 *buf++ = dst_offset;
200 *buf++ =
201 PSB_2D_SRC_SURF_BH | src_format | (src_stride <<
202 PSB_2D_SRC_STRIDE_SHIFT);
203 *buf++ = src_offset;
204 *buf++ =
205 PSB_2D_SRC_OFF_BH | (src_x << PSB_2D_SRCOFF_XSTART_SHIFT) |
206 (src_y << PSB_2D_SRCOFF_YSTART_SHIFT);
207 *buf++ = blit_cmd;
208 *buf++ =
209 (dst_x << PSB_2D_DST_XSTART_SHIFT) | (dst_y <<
210 PSB_2D_DST_YSTART_SHIFT);
211 *buf++ =
212 (size_x << PSB_2D_DST_XSIZE_SHIFT) | (size_y <<
213 PSB_2D_DST_YSIZE_SHIFT);
214 *buf++ = PSB_2D_FLUSH_BH;
215
216 return psbfb_2d_submit(dev_priv, buffer, buf - buffer);
217}
218
219
220
221
222
223
224
225
226static void psbfb_copyarea_accel(struct fb_info *info,
227 const struct fb_copyarea *a)
228{
229 struct drm_fb_helper *fb_helper = info->par;
230 struct drm_framebuffer *fb = fb_helper->fb;
231 struct drm_device *dev;
232 struct drm_psb_private *dev_priv;
233 uint32_t offset;
234 uint32_t stride;
235 uint32_t src_format;
236 uint32_t dst_format;
237
238 if (!fb)
239 return;
240
241 dev = fb->dev;
242 dev_priv = dev->dev_private;
243 offset = to_gtt_range(fb->obj[0])->offset;
244 stride = fb->pitches[0];
245
246 switch (fb->format->depth) {
247 case 8:
248 src_format = PSB_2D_SRC_332RGB;
249 dst_format = PSB_2D_DST_332RGB;
250 break;
251 case 15:
252 src_format = PSB_2D_SRC_555RGB;
253 dst_format = PSB_2D_DST_555RGB;
254 break;
255 case 16:
256 src_format = PSB_2D_SRC_565RGB;
257 dst_format = PSB_2D_DST_565RGB;
258 break;
259 case 24:
260 case 32:
261
262 src_format = PSB_2D_SRC_8888ARGB;
263 dst_format = PSB_2D_DST_8888ARGB;
264 break;
265 default:
266
267 drm_fb_helper_cfb_copyarea(info, a);
268 return;
269 }
270
271 if (!gma_power_begin(dev, false)) {
272 drm_fb_helper_cfb_copyarea(info, a);
273 return;
274 }
275 psb_accel_2d_copy(dev_priv,
276 offset, stride, src_format,
277 offset, stride, dst_format,
278 a->sx, a->sy, a->dx, a->dy, a->width, a->height);
279 gma_power_end(dev);
280}
281
282
283
284
285
286
287
288
289
290void psbfb_copyarea(struct fb_info *info,
291 const struct fb_copyarea *region)
292{
293 if (unlikely(info->state != FBINFO_STATE_RUNNING))
294 return;
295
296
297 if (region->width == 8 || region->height == 8 ||
298 (info->flags & FBINFO_HWACCEL_DISABLED))
299 return drm_fb_helper_cfb_copyarea(info, region);
300
301 psbfb_copyarea_accel(info, region);
302}
303
304
305
306
307
308
309
310
311int psbfb_sync(struct fb_info *info)
312{
313 struct drm_fb_helper *fb_helper = info->par;
314 struct drm_framebuffer *fb = fb_helper->fb;
315 struct drm_device *dev = fb->dev;
316 struct drm_psb_private *dev_priv = dev->dev_private;
317 unsigned long _end = jiffies + HZ;
318 int busy = 0;
319 unsigned long flags;
320
321 spin_lock_irqsave(&dev_priv->lock_2d, flags);
322
323
324
325
326 if ((PSB_RSGX32(PSB_CR_2D_SOCIF) == _PSB_C2_SOCIF_EMPTY) &&
327 ((PSB_RSGX32(PSB_CR_2D_BLIT_STATUS) & _PSB_C2B_STATUS_BUSY) == 0))
328 goto out;
329
330 do {
331 busy = (PSB_RSGX32(PSB_CR_2D_SOCIF) != _PSB_C2_SOCIF_EMPTY);
332 cpu_relax();
333 } while (busy && !time_after_eq(jiffies, _end));
334
335 if (busy)
336 busy = (PSB_RSGX32(PSB_CR_2D_SOCIF) != _PSB_C2_SOCIF_EMPTY);
337 if (busy)
338 goto out;
339
340 do {
341 busy = ((PSB_RSGX32(PSB_CR_2D_BLIT_STATUS) &
342 _PSB_C2B_STATUS_BUSY) != 0);
343 cpu_relax();
344 } while (busy && !time_after_eq(jiffies, _end));
345 if (busy)
346 busy = ((PSB_RSGX32(PSB_CR_2D_BLIT_STATUS) &
347 _PSB_C2B_STATUS_BUSY) != 0);
348
349out:
350 spin_unlock_irqrestore(&dev_priv->lock_2d, flags);
351 return (busy) ? -EBUSY : 0;
352}
353