blob: 91609efcb343b2e2b30e056c05c7ce2b527ba55d [file] [log] [blame]
Carter Cooper740f6742013-01-03 16:19:23 -07001/* Copyright (c) 2002,2007-2013, The Linux Foundation. All rights reserved.
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002 *
3 * This program is free software; you can redistribute it and/or modify
4 * it under the terms of the GNU General Public License version 2 and
5 * only version 2 as published by the Free Software Foundation.
6 *
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
11 *
12 */
13#include <linux/firmware.h>
14#include <linux/slab.h>
15#include <linux/sched.h>
16#include <linux/log2.h>
17
18#include "kgsl.h"
19#include "kgsl_sharedmem.h"
20#include "kgsl_cffdump.h"
Jordan Crouse72bb70b2013-05-28 17:03:52 -060021#include "kgsl_trace.h"
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070022
23#include "adreno.h"
24#include "adreno_pm4types.h"
25#include "adreno_ringbuffer.h"
26
Jeremy Gebbeneebc4612011-08-31 10:15:21 -070027#include "a2xx_reg.h"
Jordan Crouseb4d31bd2012-02-01 22:11:12 -070028#include "a3xx_reg.h"
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070029
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070030#define GSL_RB_NOP_SIZEDWORDS 2
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070031
Jordan Crousef50bfdc2012-11-01 13:48:35 -060032/*
33 * CP DEBUG settings for all cores:
34 * DYNAMIC_CLK_DISABLE [27] - turn off the dynamic clock control
35 * PROG_END_PTR_ENABLE [25] - Allow 128 bit writes to the VBIF
36 */
37
38#define CP_DEBUG_DEFAULT ((1 << 27) | (1 << 25))
39
Jordan Crouseb4d31bd2012-02-01 22:11:12 -070040void adreno_ringbuffer_submit(struct adreno_ringbuffer *rb)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070041{
42 BUG_ON(rb->wptr == 0);
43
Lucille Sylvester958dc942011-09-06 18:19:49 -060044 /* Let the pwrscale policy know that new commands have
45 been submitted. */
46 kgsl_pwrscale_busy(rb->device);
47
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070048 /*synchronize memory before informing the hardware of the
49 *new commands.
50 */
51 mb();
52
53 adreno_regwrite(rb->device, REG_CP_RB_WPTR, rb->wptr);
54}
55
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -070056static int
57adreno_ringbuffer_waitspace(struct adreno_ringbuffer *rb,
58 struct adreno_context *context,
59 unsigned int numcmds, int wptr_ahead)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070060{
61 int nopcount;
62 unsigned int freecmds;
63 unsigned int *cmds;
64 uint cmds_gpu;
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -060065 unsigned long wait_time;
Jordan Crouse21f75a02012-08-09 15:08:59 -060066 unsigned long wait_timeout = msecs_to_jiffies(ADRENO_IDLE_TIMEOUT);
Tarun Karra3335f142012-06-19 14:11:48 -070067 unsigned long wait_time_part;
Tarun Karra696f89e2013-01-27 21:31:40 -080068 unsigned int prev_reg_val[ft_detect_regs_count];
Tarun Karra3335f142012-06-19 14:11:48 -070069
70 memset(prev_reg_val, 0, sizeof(prev_reg_val));
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070071
72 /* if wptr ahead, fill the remaining with NOPs */
73 if (wptr_ahead) {
74 /* -1 for header */
75 nopcount = rb->sizedwords - rb->wptr - 1;
76
77 cmds = (unsigned int *)rb->buffer_desc.hostptr + rb->wptr;
78 cmds_gpu = rb->buffer_desc.gpuaddr + sizeof(uint)*rb->wptr;
79
Jordan Crouse084427d2011-07-28 08:37:58 -060080 GSL_RB_WRITE(cmds, cmds_gpu, cp_nop_packet(nopcount));
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070081
82 /* Make sure that rptr is not 0 before submitting
83 * commands at the end of ringbuffer. We do not
84 * want the rptr and wptr to become equal when
85 * the ringbuffer is not empty */
86 do {
87 GSL_RB_GET_READPTR(rb, &rb->rptr);
88 } while (!rb->rptr);
89
90 rb->wptr++;
91
92 adreno_ringbuffer_submit(rb);
93
94 rb->wptr = 0;
95 }
96
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -060097 wait_time = jiffies + wait_timeout;
Jordan Crouse21f75a02012-08-09 15:08:59 -060098 wait_time_part = jiffies + msecs_to_jiffies(KGSL_TIMEOUT_PART);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070099 /* wait for space in ringbuffer */
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -0600100 while (1) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700101 GSL_RB_GET_READPTR(rb, &rb->rptr);
102
103 freecmds = rb->rptr - rb->wptr;
104
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -0600105 if (freecmds == 0 || freecmds > numcmds)
106 break;
107
Tarun Karra3335f142012-06-19 14:11:48 -0700108 /* Dont wait for timeout, detect hang faster.
109 */
110 if (time_after(jiffies, wait_time_part)) {
111 wait_time_part = jiffies +
Jordan Crouse21f75a02012-08-09 15:08:59 -0600112 msecs_to_jiffies(KGSL_TIMEOUT_PART);
Tarun Karra696f89e2013-01-27 21:31:40 -0800113 if ((adreno_ft_detect(rb->device,
Tarun Karra3335f142012-06-19 14:11:48 -0700114 prev_reg_val))){
115 KGSL_DRV_ERR(rb->device,
116 "Hang detected while waiting for freespace in"
117 "ringbuffer rptr: 0x%x, wptr: 0x%x\n",
118 rb->rptr, rb->wptr);
119 goto err;
120 }
121 }
122
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -0600123 if (time_after(jiffies, wait_time)) {
124 KGSL_DRV_ERR(rb->device,
125 "Timed out while waiting for freespace in ringbuffer "
126 "rptr: 0x%x, wptr: 0x%x\n", rb->rptr, rb->wptr);
Tarun Karra3335f142012-06-19 14:11:48 -0700127 goto err;
128 }
129
Wei Zou50ec3372012-07-17 15:46:52 -0700130 continue;
131
Tarun Karra3335f142012-06-19 14:11:48 -0700132err:
Tarun Karrad20d71a2013-01-25 15:38:57 -0800133 if (!adreno_dump_and_exec_ft(rb->device)) {
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700134 if (context && context->flags & CTXT_FLAGS_GPU_HANG) {
135 KGSL_CTXT_WARN(rb->device,
136 "Context %p caused a gpu hang. Will not accept commands for context %d\n",
137 context, context->id);
138 return -EDEADLK;
139 }
140 wait_time = jiffies + wait_timeout;
141 } else {
Tarun Karrad20d71a2013-01-25 15:38:57 -0800142 /* GPU is hung and fault tolerance failed */
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700143 BUG();
144 }
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -0600145 }
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700146 return 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700147}
148
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700149unsigned int *adreno_ringbuffer_allocspace(struct adreno_ringbuffer *rb,
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700150 struct adreno_context *context,
151 unsigned int numcmds)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700152{
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700153 unsigned int *ptr = NULL;
154 int ret = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700155 BUG_ON(numcmds >= rb->sizedwords);
156
157 GSL_RB_GET_READPTR(rb, &rb->rptr);
158 /* check for available space */
159 if (rb->wptr >= rb->rptr) {
160 /* wptr ahead or equal to rptr */
161 /* reserve dwords for nop packet */
162 if ((rb->wptr + numcmds) > (rb->sizedwords -
163 GSL_RB_NOP_SIZEDWORDS))
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700164 ret = adreno_ringbuffer_waitspace(rb, context,
165 numcmds, 1);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700166 } else {
167 /* wptr behind rptr */
168 if ((rb->wptr + numcmds) >= rb->rptr)
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700169 ret = adreno_ringbuffer_waitspace(rb, context,
170 numcmds, 0);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700171 /* check for remaining space */
172 /* reserve dwords for nop packet */
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700173 if (!ret && (rb->wptr + numcmds) > (rb->sizedwords -
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700174 GSL_RB_NOP_SIZEDWORDS))
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700175 ret = adreno_ringbuffer_waitspace(rb, context,
176 numcmds, 1);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700177 }
178
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700179 if (!ret) {
180 ptr = (unsigned int *)rb->buffer_desc.hostptr + rb->wptr;
181 rb->wptr += numcmds;
182 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700183
184 return ptr;
185}
186
187static int _load_firmware(struct kgsl_device *device, const char *fwfile,
188 void **data, int *len)
189{
190 const struct firmware *fw = NULL;
191 int ret;
192
193 ret = request_firmware(&fw, fwfile, device->dev);
194
195 if (ret) {
196 KGSL_DRV_ERR(device, "request_firmware(%s) failed: %d\n",
197 fwfile, ret);
198 return ret;
199 }
200
201 *data = kmalloc(fw->size, GFP_KERNEL);
202
203 if (*data) {
204 memcpy(*data, fw->data, fw->size);
205 *len = fw->size;
206 } else
207 KGSL_MEM_ERR(device, "kmalloc(%d) failed\n", fw->size);
208
209 release_firmware(fw);
210 return (*data != NULL) ? 0 : -ENOMEM;
211}
212
Tarun Karra9c070822012-11-27 16:43:51 -0700213int adreno_ringbuffer_read_pm4_ucode(struct kgsl_device *device)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700214{
215 struct adreno_device *adreno_dev = ADRENO_DEVICE(device);
Tarun Karra9c070822012-11-27 16:43:51 -0700216 int ret = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700217
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700218 if (adreno_dev->pm4_fw == NULL) {
219 int len;
Jordan Crouse505df9c2011-07-28 08:37:59 -0600220 void *ptr;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700221
Jordan Crouse505df9c2011-07-28 08:37:59 -0600222 ret = _load_firmware(device, adreno_dev->pm4_fwfile,
223 &ptr, &len);
224
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700225 if (ret)
226 goto err;
227
228 /* PM4 size is 3 dword aligned plus 1 dword of version */
229 if (len % ((sizeof(uint32_t) * 3)) != sizeof(uint32_t)) {
230 KGSL_DRV_ERR(device, "Bad firmware size: %d\n", len);
231 ret = -EINVAL;
Jeremy Gebben79acee62011-08-08 16:44:07 -0600232 kfree(ptr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700233 goto err;
234 }
235
236 adreno_dev->pm4_fw_size = len / sizeof(uint32_t);
237 adreno_dev->pm4_fw = ptr;
Tarun Karra9c070822012-11-27 16:43:51 -0700238 adreno_dev->pm4_fw_version = adreno_dev->pm4_fw[1];
239 }
240
241err:
242 return ret;
243}
244
245
246int adreno_ringbuffer_load_pm4_ucode(struct kgsl_device *device)
247{
248 struct adreno_device *adreno_dev = ADRENO_DEVICE(device);
249 int i;
250
251 if (adreno_dev->pm4_fw == NULL) {
252 int ret = adreno_ringbuffer_read_pm4_ucode(device);
253 if (ret)
254 return ret;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700255 }
256
257 KGSL_DRV_INFO(device, "loading pm4 ucode version: %d\n",
Tarun Karra9c070822012-11-27 16:43:51 -0700258 adreno_dev->pm4_fw_version);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700259
Jordan Crousef50bfdc2012-11-01 13:48:35 -0600260 adreno_regwrite(device, REG_CP_DEBUG, CP_DEBUG_DEFAULT);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700261 adreno_regwrite(device, REG_CP_ME_RAM_WADDR, 0);
262 for (i = 1; i < adreno_dev->pm4_fw_size; i++)
263 adreno_regwrite(device, REG_CP_ME_RAM_DATA,
Tarun Karra9c070822012-11-27 16:43:51 -0700264 adreno_dev->pm4_fw[i]);
265
266 return 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700267}
268
Tarun Karra9c070822012-11-27 16:43:51 -0700269int adreno_ringbuffer_read_pfp_ucode(struct kgsl_device *device)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700270{
271 struct adreno_device *adreno_dev = ADRENO_DEVICE(device);
Tarun Karra9c070822012-11-27 16:43:51 -0700272 int ret = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700273
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700274 if (adreno_dev->pfp_fw == NULL) {
275 int len;
Jordan Crouse505df9c2011-07-28 08:37:59 -0600276 void *ptr;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700277
Jordan Crouse505df9c2011-07-28 08:37:59 -0600278 ret = _load_firmware(device, adreno_dev->pfp_fwfile,
279 &ptr, &len);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700280 if (ret)
281 goto err;
282
283 /* PFP size shold be dword aligned */
284 if (len % sizeof(uint32_t) != 0) {
285 KGSL_DRV_ERR(device, "Bad firmware size: %d\n", len);
286 ret = -EINVAL;
Jeremy Gebben79acee62011-08-08 16:44:07 -0600287 kfree(ptr);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700288 goto err;
289 }
290
291 adreno_dev->pfp_fw_size = len / sizeof(uint32_t);
292 adreno_dev->pfp_fw = ptr;
Tarun Karra9c070822012-11-27 16:43:51 -0700293 adreno_dev->pfp_fw_version = adreno_dev->pfp_fw[5];
294 }
295
296err:
297 return ret;
298}
299
300int adreno_ringbuffer_load_pfp_ucode(struct kgsl_device *device)
301{
302 struct adreno_device *adreno_dev = ADRENO_DEVICE(device);
303 int i;
304
305 if (adreno_dev->pfp_fw == NULL) {
306 int ret = adreno_ringbuffer_read_pfp_ucode(device);
307 if (ret)
308 return ret;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700309 }
310
311 KGSL_DRV_INFO(device, "loading pfp ucode version: %d\n",
Tarun Karra9c070822012-11-27 16:43:51 -0700312 adreno_dev->pfp_fw_version);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700313
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700314 adreno_regwrite(device, adreno_dev->gpudev->reg_cp_pfp_ucode_addr, 0);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700315 for (i = 1; i < adreno_dev->pfp_fw_size; i++)
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700316 adreno_regwrite(device,
Tarun Karra9c070822012-11-27 16:43:51 -0700317 adreno_dev->gpudev->reg_cp_pfp_ucode_data,
318 adreno_dev->pfp_fw[i]);
319
320 return 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700321}
322
323int adreno_ringbuffer_start(struct adreno_ringbuffer *rb, unsigned int init_ram)
324{
325 int status;
326 /*cp_rb_cntl_u cp_rb_cntl; */
327 union reg_cp_rb_cntl cp_rb_cntl;
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700328 unsigned int rb_cntl;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700329 struct kgsl_device *device = rb->device;
Jeremy Gebbenddf6b572011-09-09 13:39:49 -0700330 struct adreno_device *adreno_dev = ADRENO_DEVICE(device);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700331
332 if (rb->flags & KGSL_FLAGS_STARTED)
333 return 0;
334
Carter Coopercb3e8eb2012-04-11 09:39:40 -0600335 if (init_ram)
Carter Cooper9cf77b62013-05-28 17:04:26 -0600336 rb->global_ts = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700337
338 kgsl_sharedmem_set(&rb->memptrs_desc, 0, 0,
339 sizeof(struct kgsl_rbmemptrs));
340
341 kgsl_sharedmem_set(&rb->buffer_desc, 0, 0xAA,
342 (rb->sizedwords << 2));
343
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700344 if (adreno_is_a2xx(adreno_dev)) {
345 adreno_regwrite(device, REG_CP_RB_WPTR_BASE,
346 (rb->memptrs_desc.gpuaddr
347 + GSL_RB_MEMPTRS_WPTRPOLL_OFFSET));
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700348
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700349 /* setup WPTR delay */
350 adreno_regwrite(device, REG_CP_RB_WPTR_DELAY,
351 0 /*0x70000010 */);
352 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700353
354 /*setup REG_CP_RB_CNTL */
355 adreno_regread(device, REG_CP_RB_CNTL, &rb_cntl);
356 cp_rb_cntl.val = rb_cntl;
357
358 /*
359 * The size of the ringbuffer in the hardware is the log2
360 * representation of the size in quadwords (sizedwords / 2)
361 */
362 cp_rb_cntl.f.rb_bufsz = ilog2(rb->sizedwords >> 1);
363
364 /*
365 * Specify the quadwords to read before updating mem RPTR.
366 * Like above, pass the log2 representation of the blocksize
367 * in quadwords.
368 */
369 cp_rb_cntl.f.rb_blksz = ilog2(KGSL_RB_BLKSIZE >> 3);
370
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700371 if (adreno_is_a2xx(adreno_dev)) {
372 /* WPTR polling */
373 cp_rb_cntl.f.rb_poll_en = GSL_RB_CNTL_POLL_EN;
374 }
375
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700376 /* mem RPTR writebacks */
377 cp_rb_cntl.f.rb_no_update = GSL_RB_CNTL_NO_UPDATE;
378
379 adreno_regwrite(device, REG_CP_RB_CNTL, cp_rb_cntl.val);
380
381 adreno_regwrite(device, REG_CP_RB_BASE, rb->buffer_desc.gpuaddr);
382
383 adreno_regwrite(device, REG_CP_RB_RPTR_ADDR,
384 rb->memptrs_desc.gpuaddr +
385 GSL_RB_MEMPTRS_RPTR_OFFSET);
386
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700387 if (adreno_is_a3xx(adreno_dev)) {
388 /* enable access protection to privileged registers */
389 adreno_regwrite(device, A3XX_CP_PROTECT_CTRL, 0x00000007);
390
391 /* RBBM registers */
392 adreno_regwrite(device, A3XX_CP_PROTECT_REG_0, 0x63000040);
393 adreno_regwrite(device, A3XX_CP_PROTECT_REG_1, 0x62000080);
394 adreno_regwrite(device, A3XX_CP_PROTECT_REG_2, 0x600000CC);
395 adreno_regwrite(device, A3XX_CP_PROTECT_REG_3, 0x60000108);
396 adreno_regwrite(device, A3XX_CP_PROTECT_REG_4, 0x64000140);
397 adreno_regwrite(device, A3XX_CP_PROTECT_REG_5, 0x66000400);
398
399 /* CP registers */
400 adreno_regwrite(device, A3XX_CP_PROTECT_REG_6, 0x65000700);
401 adreno_regwrite(device, A3XX_CP_PROTECT_REG_7, 0x610007D8);
402 adreno_regwrite(device, A3XX_CP_PROTECT_REG_8, 0x620007E0);
403 adreno_regwrite(device, A3XX_CP_PROTECT_REG_9, 0x61001178);
404 adreno_regwrite(device, A3XX_CP_PROTECT_REG_A, 0x64001180);
405
406 /* RB registers */
407 adreno_regwrite(device, A3XX_CP_PROTECT_REG_B, 0x60003300);
408
409 /* VBIF registers */
410 adreno_regwrite(device, A3XX_CP_PROTECT_REG_C, 0x6B00C000);
411 }
412
413 if (adreno_is_a2xx(adreno_dev)) {
414 /* explicitly clear all cp interrupts */
415 adreno_regwrite(device, REG_CP_INT_ACK, 0xFFFFFFFF);
416 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700417
418 /* setup scratch/timestamp */
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700419 adreno_regwrite(device, REG_SCRATCH_ADDR, device->memstore.gpuaddr +
420 KGSL_MEMSTORE_OFFSET(KGSL_MEMSTORE_GLOBAL,
421 soptimestamp));
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700422
423 adreno_regwrite(device, REG_SCRATCH_UMSK,
424 GSL_RB_MEMPTRS_SCRATCH_MASK);
425
426 /* load the CP ucode */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700427 status = adreno_ringbuffer_load_pm4_ucode(device);
428 if (status != 0)
429 return status;
430
431 /* load the prefetch parser ucode */
432 status = adreno_ringbuffer_load_pfp_ucode(device);
433 if (status != 0)
434 return status;
435
Kevin Matlageff806df2012-05-07 18:13:21 -0600436 /* CP ROQ queue sizes (bytes) - RB:16, ST:16, IB1:32, IB2:64 */
Kevin Matlagee8d35862012-04-26 12:58:15 -0600437 if (adreno_is_a305(adreno_dev) || adreno_is_a320(adreno_dev))
Kevin Matlageff806df2012-05-07 18:13:21 -0600438 adreno_regwrite(device, REG_CP_QUEUE_THRESHOLDS, 0x000E0602);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700439
440 rb->rptr = 0;
441 rb->wptr = 0;
442
443 /* clear ME_HALT to start micro engine */
444 adreno_regwrite(device, REG_CP_ME_CNTL, 0);
445
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700446 /* ME init is GPU specific, so jump into the sub-function */
447 adreno_dev->gpudev->rb_init(adreno_dev, rb);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700448
449 /* idle device to validate ME INIT */
Jordan Crousea29a2e02012-08-14 09:09:23 -0600450 status = adreno_idle(device);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700451
452 if (status == 0)
453 rb->flags |= KGSL_FLAGS_STARTED;
454
455 return status;
456}
457
Carter Cooper6dd94c82011-10-13 14:43:53 -0600458void adreno_ringbuffer_stop(struct adreno_ringbuffer *rb)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700459{
Rajeev Kulkarnibf7a3822012-08-14 21:21:14 +0530460 struct kgsl_device *device = rb->device;
461 struct adreno_device *adreno_dev = ADRENO_DEVICE(device);
462
463 if (rb->flags & KGSL_FLAGS_STARTED) {
464 if (adreno_is_a200(adreno_dev))
465 adreno_regwrite(rb->device, REG_CP_ME_CNTL, 0x10000000);
466
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700467 rb->flags &= ~KGSL_FLAGS_STARTED;
Rajeev Kulkarnibf7a3822012-08-14 21:21:14 +0530468 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700469}
470
471int adreno_ringbuffer_init(struct kgsl_device *device)
472{
473 int status;
474 struct adreno_device *adreno_dev = ADRENO_DEVICE(device);
475 struct adreno_ringbuffer *rb = &adreno_dev->ringbuffer;
476
477 rb->device = device;
478 /*
479 * It is silly to convert this to words and then back to bytes
480 * immediately below, but most of the rest of the code deals
481 * in words, so we might as well only do the math once
482 */
483 rb->sizedwords = KGSL_RB_SIZE >> 2;
484
485 /* allocate memory for ringbuffer */
486 status = kgsl_allocate_contiguous(&rb->buffer_desc,
487 (rb->sizedwords << 2));
488
489 if (status != 0) {
490 adreno_ringbuffer_close(rb);
491 return status;
492 }
493
494 /* allocate memory for polling and timestamps */
495 /* This really can be at 4 byte alignment boundry but for using MMU
496 * we need to make it at page boundary */
497 status = kgsl_allocate_contiguous(&rb->memptrs_desc,
498 sizeof(struct kgsl_rbmemptrs));
499
500 if (status != 0) {
501 adreno_ringbuffer_close(rb);
502 return status;
503 }
504
505 /* overlay structure on memptrs memory */
506 rb->memptrs = (struct kgsl_rbmemptrs *) rb->memptrs_desc.hostptr;
507
508 return 0;
509}
510
Carter Cooper6dd94c82011-10-13 14:43:53 -0600511void adreno_ringbuffer_close(struct adreno_ringbuffer *rb)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700512{
513 struct adreno_device *adreno_dev = ADRENO_DEVICE(rb->device);
514
515 kgsl_sharedmem_free(&rb->buffer_desc);
516 kgsl_sharedmem_free(&rb->memptrs_desc);
517
518 kfree(adreno_dev->pfp_fw);
519 kfree(adreno_dev->pm4_fw);
520
521 adreno_dev->pfp_fw = NULL;
522 adreno_dev->pm4_fw = NULL;
523
524 memset(rb, 0, sizeof(struct adreno_ringbuffer));
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700525}
526
Carter Cooper9cf77b62013-05-28 17:04:26 -0600527static int
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700528adreno_ringbuffer_addcmds(struct adreno_ringbuffer *rb,
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700529 struct adreno_context *context,
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700530 unsigned int flags, unsigned int *cmds,
Carter Cooper9cf77b62013-05-28 17:04:26 -0600531 int sizedwords)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700532{
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700533 struct adreno_device *adreno_dev = ADRENO_DEVICE(rb->device);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700534 unsigned int *ringcmds;
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700535 unsigned int total_sizedwords = sizedwords;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700536 unsigned int i;
537 unsigned int rcmd_gpu;
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700538 unsigned int context_id = KGSL_MEMSTORE_GLOBAL;
539 unsigned int gpuaddr = rb->device->memstore.gpuaddr;
Carter Cooper9cf77b62013-05-28 17:04:26 -0600540 unsigned int timestamp;
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700541
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -0600542 /*
543 * if the context was not created with per context timestamp
544 * support, we must use the global timestamp since issueibcmds
545 * will be returning that one.
546 */
Carter Cooper9cf77b62013-05-28 17:04:26 -0600547 if (context && context->flags & CTXT_FLAGS_PER_CONTEXT_TS &&
548 !(flags & KGSL_CMD_FLAGS_INTERNAL_ISSUE))
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -0600549 context_id = context->id;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700550
551 /* reserve space to temporarily turn off protected mode
552 * error checking if needed
553 */
554 total_sizedwords += flags & KGSL_CMD_FLAGS_PMODE ? 4 : 0;
Shubhraprakash Dasc3ad5802012-05-30 18:10:06 -0600555 /* 2 dwords to store the start of command sequence */
556 total_sizedwords += 2;
Jordan Crouseef02fc02013-03-05 11:19:31 -0700557
Carter Cooper728bd152013-05-28 17:00:06 -0600558 /* internal ib command identifier for the ringbuffer */
559 total_sizedwords += (flags & KGSL_CMD_FLAGS_INTERNAL_ISSUE) ? 2 : 0;
560
Jordan Crouseef02fc02013-03-05 11:19:31 -0700561 /* Add CP_COND_EXEC commands to generate CP_INTERRUPT */
562 total_sizedwords += context ? 13 : 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700563
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700564 if (adreno_is_a3xx(adreno_dev))
565 total_sizedwords += 7;
566
Anshuman Danica4e1a72012-11-06 22:19:50 +0530567 if (adreno_is_a2xx(adreno_dev))
568 total_sizedwords += 2; /* CP_WAIT_FOR_IDLE */
569
Tarun Karrad20d71a2013-01-25 15:38:57 -0800570 total_sizedwords += 2; /* scratchpad ts for fault tolerance */
Anshuman Dani9ce83972013-05-28 17:01:10 -0600571
Vijay Krishnamoorthye80c3462012-08-27 14:07:32 -0700572 if (context && context->flags & CTXT_FLAGS_PER_CONTEXT_TS &&
573 !(flags & KGSL_CMD_FLAGS_INTERNAL_ISSUE)) {
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700574 total_sizedwords += 3; /* sop timestamp */
575 total_sizedwords += 4; /* eop timestamp */
Rajesh Kemisettic5699302012-04-21 21:09:05 +0530576 total_sizedwords += 3; /* global timestamp without cache
577 * flush for non-zero context */
578 } else {
Tarun Karrad20d71a2013-01-25 15:38:57 -0800579 total_sizedwords += 4; /* global timestamp for fault tolerance*/
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700580 }
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700581
Tarun Karra6479d072013-03-27 19:37:55 -0700582 if (flags & KGSL_CMD_FLAGS_EOF)
583 total_sizedwords += 2;
584
Shubhraprakash Dasd316ff82012-08-02 12:43:48 -0700585 ringcmds = adreno_ringbuffer_allocspace(rb, context, total_sizedwords);
Carter Cooper9cf77b62013-05-28 17:04:26 -0600586 if (!ringcmds)
587 return -ENOSPC;
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -0600588
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700589 rcmd_gpu = rb->buffer_desc.gpuaddr
590 + sizeof(uint)*(rb->wptr-total_sizedwords);
591
Shubhraprakash Dasc3ad5802012-05-30 18:10:06 -0600592 GSL_RB_WRITE(ringcmds, rcmd_gpu, cp_nop_packet(1));
593 GSL_RB_WRITE(ringcmds, rcmd_gpu, KGSL_CMD_IDENTIFIER);
594
Carter Cooper728bd152013-05-28 17:00:06 -0600595 if (flags & KGSL_CMD_FLAGS_INTERNAL_ISSUE) {
596 GSL_RB_WRITE(ringcmds, rcmd_gpu, cp_nop_packet(1));
597 GSL_RB_WRITE(ringcmds, rcmd_gpu, KGSL_CMD_INTERNAL_IDENTIFIER);
598 }
599
Carter Cooper9cf77b62013-05-28 17:04:26 -0600600 /* always increment the global timestamp. once. */
601 rb->global_ts++;
602
603 if (KGSL_MEMSTORE_GLOBAL != context_id)
604 timestamp = context->timestamp;
605 else
606 timestamp = rb->global_ts;
607
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700608 if (flags & KGSL_CMD_FLAGS_PMODE) {
609 /* disable protected mode error checking */
610 GSL_RB_WRITE(ringcmds, rcmd_gpu,
Jordan Crouse084427d2011-07-28 08:37:58 -0600611 cp_type3_packet(CP_SET_PROTECTED_MODE, 1));
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700612 GSL_RB_WRITE(ringcmds, rcmd_gpu, 0);
613 }
614
615 for (i = 0; i < sizedwords; i++) {
616 GSL_RB_WRITE(ringcmds, rcmd_gpu, *cmds);
617 cmds++;
618 }
619
620 if (flags & KGSL_CMD_FLAGS_PMODE) {
621 /* re-enable protected mode error checking */
622 GSL_RB_WRITE(ringcmds, rcmd_gpu,
Jordan Crouse084427d2011-07-28 08:37:58 -0600623 cp_type3_packet(CP_SET_PROTECTED_MODE, 1));
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700624 GSL_RB_WRITE(ringcmds, rcmd_gpu, 1);
625 }
626
Anshuman Danica4e1a72012-11-06 22:19:50 +0530627 /* HW Workaround for MMU Page fault
628 * due to memory getting free early before
629 * GPU completes it.
630 */
631 if (adreno_is_a2xx(adreno_dev)) {
632 GSL_RB_WRITE(ringcmds, rcmd_gpu,
633 cp_type3_packet(CP_WAIT_FOR_IDLE, 1));
634 GSL_RB_WRITE(ringcmds, rcmd_gpu, 0x00);
635 }
636
Tarun Karrad20d71a2013-01-25 15:38:57 -0800637 /* scratchpad ts for fault tolerance */
Jordan Crouse084427d2011-07-28 08:37:58 -0600638 GSL_RB_WRITE(ringcmds, rcmd_gpu, cp_type0_packet(REG_CP_TIMESTAMP, 1));
Carter Cooper9cf77b62013-05-28 17:04:26 -0600639 GSL_RB_WRITE(ringcmds, rcmd_gpu, rb->global_ts);
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700640
641 if (adreno_is_a3xx(adreno_dev)) {
642 /*
643 * FLush HLSQ lazy updates to make sure there are no
644 * rsources pending for indirect loads after the timestamp
645 */
646
647 GSL_RB_WRITE(ringcmds, rcmd_gpu,
648 cp_type3_packet(CP_EVENT_WRITE, 1));
649 GSL_RB_WRITE(ringcmds, rcmd_gpu, 0x07); /* HLSQ_FLUSH */
650 GSL_RB_WRITE(ringcmds, rcmd_gpu,
651 cp_type3_packet(CP_WAIT_FOR_IDLE, 1));
652 GSL_RB_WRITE(ringcmds, rcmd_gpu, 0x00);
653 }
654
Vijay Krishnamoorthye80c3462012-08-27 14:07:32 -0700655 if (context && context->flags & CTXT_FLAGS_PER_CONTEXT_TS
656 && !(flags & KGSL_CMD_FLAGS_INTERNAL_ISSUE)) {
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700657 /* start-of-pipeline timestamp */
658 GSL_RB_WRITE(ringcmds, rcmd_gpu,
659 cp_type3_packet(CP_MEM_WRITE, 2));
660 GSL_RB_WRITE(ringcmds, rcmd_gpu, (gpuaddr +
Carter Cooper7ffaba62012-05-24 13:59:53 -0600661 KGSL_MEMSTORE_OFFSET(context_id, soptimestamp)));
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700662 GSL_RB_WRITE(ringcmds, rcmd_gpu, timestamp);
663
664 /* end-of-pipeline timestamp */
665 GSL_RB_WRITE(ringcmds, rcmd_gpu,
666 cp_type3_packet(CP_EVENT_WRITE, 3));
667 GSL_RB_WRITE(ringcmds, rcmd_gpu, CACHE_FLUSH_TS);
668 GSL_RB_WRITE(ringcmds, rcmd_gpu, (gpuaddr +
Carter Cooper7ffaba62012-05-24 13:59:53 -0600669 KGSL_MEMSTORE_OFFSET(context_id, eoptimestamp)));
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700670 GSL_RB_WRITE(ringcmds, rcmd_gpu, timestamp);
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700671
Rajesh Kemisettic5699302012-04-21 21:09:05 +0530672 GSL_RB_WRITE(ringcmds, rcmd_gpu,
673 cp_type3_packet(CP_MEM_WRITE, 2));
674 GSL_RB_WRITE(ringcmds, rcmd_gpu, (gpuaddr +
Carter Cooper7ffaba62012-05-24 13:59:53 -0600675 KGSL_MEMSTORE_OFFSET(KGSL_MEMSTORE_GLOBAL,
676 eoptimestamp)));
Carter Cooper9cf77b62013-05-28 17:04:26 -0600677 GSL_RB_WRITE(ringcmds, rcmd_gpu, rb->global_ts);
Rajesh Kemisettic5699302012-04-21 21:09:05 +0530678 } else {
679 GSL_RB_WRITE(ringcmds, rcmd_gpu,
680 cp_type3_packet(CP_EVENT_WRITE, 3));
681 GSL_RB_WRITE(ringcmds, rcmd_gpu, CACHE_FLUSH_TS);
682 GSL_RB_WRITE(ringcmds, rcmd_gpu, (gpuaddr +
Vijay Krishnamoorthye80c3462012-08-27 14:07:32 -0700683 KGSL_MEMSTORE_OFFSET(KGSL_MEMSTORE_GLOBAL,
684 eoptimestamp)));
Carter Cooper9cf77b62013-05-28 17:04:26 -0600685 GSL_RB_WRITE(ringcmds, rcmd_gpu, rb->global_ts);
Rajesh Kemisettic5699302012-04-21 21:09:05 +0530686 }
Rajeev Kulkarnid98d6562013-01-02 16:10:56 -0800687 if (context) {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700688 /* Conditional execution based on memory values */
689 GSL_RB_WRITE(ringcmds, rcmd_gpu,
Jordan Crouse084427d2011-07-28 08:37:58 -0600690 cp_type3_packet(CP_COND_EXEC, 4));
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700691 GSL_RB_WRITE(ringcmds, rcmd_gpu, (gpuaddr +
692 KGSL_MEMSTORE_OFFSET(
693 context_id, ts_cmp_enable)) >> 2);
694 GSL_RB_WRITE(ringcmds, rcmd_gpu, (gpuaddr +
695 KGSL_MEMSTORE_OFFSET(
696 context_id, ref_wait_ts)) >> 2);
697 GSL_RB_WRITE(ringcmds, rcmd_gpu, timestamp);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700698 /* # of conditional command DWORDs */
Jordan Crouseef02fc02013-03-05 11:19:31 -0700699 GSL_RB_WRITE(ringcmds, rcmd_gpu, 8);
700
701 /* Clear the ts_cmp_enable for the context */
702 GSL_RB_WRITE(ringcmds, rcmd_gpu,
703 cp_type3_packet(CP_MEM_WRITE, 2));
704 GSL_RB_WRITE(ringcmds, rcmd_gpu, gpuaddr +
705 KGSL_MEMSTORE_OFFSET(
706 context_id, ts_cmp_enable));
707 GSL_RB_WRITE(ringcmds, rcmd_gpu, 0x0);
708
709 /* Clear the ts_cmp_enable for the global timestamp */
710 GSL_RB_WRITE(ringcmds, rcmd_gpu,
711 cp_type3_packet(CP_MEM_WRITE, 2));
712 GSL_RB_WRITE(ringcmds, rcmd_gpu, gpuaddr +
713 KGSL_MEMSTORE_OFFSET(
714 KGSL_MEMSTORE_GLOBAL, ts_cmp_enable));
715 GSL_RB_WRITE(ringcmds, rcmd_gpu, 0x0);
716
717 /* Trigger the interrupt */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700718 GSL_RB_WRITE(ringcmds, rcmd_gpu,
Jordan Crouse084427d2011-07-28 08:37:58 -0600719 cp_type3_packet(CP_INTERRUPT, 1));
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700720 GSL_RB_WRITE(ringcmds, rcmd_gpu, CP_INT_CNTL__RB_INT_MASK);
721 }
722
Jordan Crouseb4d31bd2012-02-01 22:11:12 -0700723 if (adreno_is_a3xx(adreno_dev)) {
724 /* Dummy set-constant to trigger context rollover */
725 GSL_RB_WRITE(ringcmds, rcmd_gpu,
726 cp_type3_packet(CP_SET_CONSTANT, 2));
727 GSL_RB_WRITE(ringcmds, rcmd_gpu,
728 (0x4<<16)|(A3XX_HLSQ_CL_KERNEL_GROUP_X_REG - 0x2000));
729 GSL_RB_WRITE(ringcmds, rcmd_gpu, 0);
730 }
731
Tarun Karradeeecc02013-01-21 23:42:17 -0800732 if (flags & KGSL_CMD_FLAGS_EOF) {
733 GSL_RB_WRITE(ringcmds, rcmd_gpu, cp_nop_packet(1));
734 GSL_RB_WRITE(ringcmds, rcmd_gpu, KGSL_END_OF_FRAME_IDENTIFIER);
735 }
736
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700737 adreno_ringbuffer_submit(rb);
738
Carter Cooper9cf77b62013-05-28 17:04:26 -0600739 return 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700740}
741
Shubhraprakash Dascb068072012-06-07 17:52:41 -0600742unsigned int
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700743adreno_ringbuffer_issuecmds(struct kgsl_device *device,
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -0600744 struct adreno_context *drawctxt,
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700745 unsigned int flags,
746 unsigned int *cmds,
747 int sizedwords)
748{
749 struct adreno_device *adreno_dev = ADRENO_DEVICE(device);
750 struct adreno_ringbuffer *rb = &adreno_dev->ringbuffer;
751
752 if (device->state & KGSL_STATE_HUNG)
Shubhraprakash Dascb068072012-06-07 17:52:41 -0600753 return kgsl_readtimestamp(device, KGSL_MEMSTORE_GLOBAL,
754 KGSL_TIMESTAMP_RETIRED);
Vijay Krishnamoorthye80c3462012-08-27 14:07:32 -0700755
756 flags |= KGSL_CMD_FLAGS_INTERNAL_ISSUE;
757
758 return adreno_ringbuffer_addcmds(rb, drawctxt, flags, cmds,
Carter Cooper9cf77b62013-05-28 17:04:26 -0600759 sizedwords);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700760}
761
Jeremy Gebbend0ab6ad2012-04-06 11:13:35 -0600762static bool _parse_ibs(struct kgsl_device_private *dev_priv, uint gpuaddr,
763 int sizedwords);
764
765static bool
766_handle_type3(struct kgsl_device_private *dev_priv, uint *hostaddr)
767{
768 unsigned int opcode = cp_type3_opcode(*hostaddr);
769 switch (opcode) {
770 case CP_INDIRECT_BUFFER_PFD:
771 case CP_INDIRECT_BUFFER_PFE:
772 case CP_COND_INDIRECT_BUFFER_PFE:
773 case CP_COND_INDIRECT_BUFFER_PFD:
774 return _parse_ibs(dev_priv, hostaddr[1], hostaddr[2]);
775 case CP_NOP:
776 case CP_WAIT_FOR_IDLE:
777 case CP_WAIT_REG_MEM:
778 case CP_WAIT_REG_EQ:
779 case CP_WAT_REG_GTE:
780 case CP_WAIT_UNTIL_READ:
781 case CP_WAIT_IB_PFD_COMPLETE:
782 case CP_REG_RMW:
783 case CP_REG_TO_MEM:
784 case CP_MEM_WRITE:
785 case CP_MEM_WRITE_CNTR:
786 case CP_COND_EXEC:
787 case CP_COND_WRITE:
788 case CP_EVENT_WRITE:
789 case CP_EVENT_WRITE_SHD:
790 case CP_EVENT_WRITE_CFL:
791 case CP_EVENT_WRITE_ZPD:
792 case CP_DRAW_INDX:
793 case CP_DRAW_INDX_2:
794 case CP_DRAW_INDX_BIN:
795 case CP_DRAW_INDX_2_BIN:
796 case CP_VIZ_QUERY:
797 case CP_SET_STATE:
798 case CP_SET_CONSTANT:
799 case CP_IM_LOAD:
800 case CP_IM_LOAD_IMMEDIATE:
801 case CP_LOAD_CONSTANT_CONTEXT:
802 case CP_INVALIDATE_STATE:
803 case CP_SET_SHADER_BASES:
804 case CP_SET_BIN_MASK:
805 case CP_SET_BIN_SELECT:
806 case CP_SET_BIN_BASE_OFFSET:
807 case CP_SET_BIN_DATA:
808 case CP_CONTEXT_UPDATE:
809 case CP_INTERRUPT:
810 case CP_IM_STORE:
811 case CP_LOAD_STATE:
812 break;
813 /* these shouldn't come from userspace */
814 case CP_ME_INIT:
815 case CP_SET_PROTECTED_MODE:
816 default:
817 KGSL_CMD_ERR(dev_priv->device, "bad CP opcode %0x\n", opcode);
818 return false;
819 break;
820 }
821
822 return true;
823}
824
825static bool
826_handle_type0(struct kgsl_device_private *dev_priv, uint *hostaddr)
827{
828 unsigned int reg = type0_pkt_offset(*hostaddr);
829 unsigned int cnt = type0_pkt_size(*hostaddr);
830 if (reg < 0x0192 || (reg + cnt) >= 0x8000) {
831 KGSL_CMD_ERR(dev_priv->device, "bad type0 reg: 0x%0x cnt: %d\n",
832 reg, cnt);
833 return false;
834 }
835 return true;
836}
837
838/*
839 * Traverse IBs and dump them to test vector. Detect swap by inspecting
840 * register writes, keeping note of the current state, and dump
841 * framebuffer config to test vector
842 */
843static bool _parse_ibs(struct kgsl_device_private *dev_priv,
844 uint gpuaddr, int sizedwords)
845{
846 static uint level; /* recursion level */
847 bool ret = false;
848 uint *hostaddr, *hoststart;
849 int dwords_left = sizedwords; /* dwords left in the current command
850 buffer */
851 struct kgsl_mem_entry *entry;
852
853 spin_lock(&dev_priv->process_priv->mem_lock);
854 entry = kgsl_sharedmem_find_region(dev_priv->process_priv,
855 gpuaddr, sizedwords * sizeof(uint));
856 spin_unlock(&dev_priv->process_priv->mem_lock);
857 if (entry == NULL) {
858 KGSL_CMD_ERR(dev_priv->device,
859 "no mapping for gpuaddr: 0x%08x\n", gpuaddr);
860 return false;
861 }
862
863 hostaddr = (uint *)kgsl_gpuaddr_to_vaddr(&entry->memdesc, gpuaddr);
864 if (hostaddr == NULL) {
865 KGSL_CMD_ERR(dev_priv->device,
866 "no mapping for gpuaddr: 0x%08x\n", gpuaddr);
867 return false;
868 }
869
870 hoststart = hostaddr;
871
872 level++;
873
874 KGSL_CMD_INFO(dev_priv->device, "ib: gpuaddr:0x%08x, wc:%d, hptr:%p\n",
875 gpuaddr, sizedwords, hostaddr);
876
877 mb();
878 while (dwords_left > 0) {
879 bool cur_ret = true;
880 int count = 0; /* dword count including packet header */
881
882 switch (*hostaddr >> 30) {
883 case 0x0: /* type-0 */
884 count = (*hostaddr >> 16)+2;
885 cur_ret = _handle_type0(dev_priv, hostaddr);
886 break;
887 case 0x1: /* type-1 */
888 count = 2;
889 break;
890 case 0x3: /* type-3 */
891 count = ((*hostaddr >> 16) & 0x3fff) + 2;
892 cur_ret = _handle_type3(dev_priv, hostaddr);
893 break;
894 default:
895 KGSL_CMD_ERR(dev_priv->device, "unexpected type: "
896 "type:%d, word:0x%08x @ 0x%p, gpu:0x%08x\n",
897 *hostaddr >> 30, *hostaddr, hostaddr,
898 gpuaddr+4*(sizedwords-dwords_left));
899 cur_ret = false;
900 count = dwords_left;
901 break;
902 }
903
904 if (!cur_ret) {
905 KGSL_CMD_ERR(dev_priv->device,
906 "bad sub-type: #:%d/%d, v:0x%08x"
907 " @ 0x%p[gb:0x%08x], level:%d\n",
908 sizedwords-dwords_left, sizedwords, *hostaddr,
909 hostaddr, gpuaddr+4*(sizedwords-dwords_left),
910 level);
911
912 if (ADRENO_DEVICE(dev_priv->device)->ib_check_level
913 >= 2)
914 print_hex_dump(KERN_ERR,
915 level == 1 ? "IB1:" : "IB2:",
916 DUMP_PREFIX_OFFSET, 32, 4, hoststart,
917 sizedwords*4, 0);
918 goto done;
919 }
920
921 /* jump to next packet */
922 dwords_left -= count;
923 hostaddr += count;
924 if (dwords_left < 0) {
925 KGSL_CMD_ERR(dev_priv->device,
926 "bad count: c:%d, #:%d/%d, "
927 "v:0x%08x @ 0x%p[gb:0x%08x], level:%d\n",
928 count, sizedwords-(dwords_left+count),
929 sizedwords, *(hostaddr-count), hostaddr-count,
930 gpuaddr+4*(sizedwords-(dwords_left+count)),
931 level);
932 if (ADRENO_DEVICE(dev_priv->device)->ib_check_level
933 >= 2)
934 print_hex_dump(KERN_ERR,
935 level == 1 ? "IB1:" : "IB2:",
936 DUMP_PREFIX_OFFSET, 32, 4, hoststart,
937 sizedwords*4, 0);
938 goto done;
939 }
940 }
941
942 ret = true;
943done:
944 if (!ret)
945 KGSL_DRV_ERR(dev_priv->device,
946 "parsing failed: gpuaddr:0x%08x, "
947 "host:0x%p, wc:%d\n", gpuaddr, hoststart, sizedwords);
948
949 level--;
950
951 return ret;
952}
953
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700954int
955adreno_ringbuffer_issueibcmds(struct kgsl_device_private *dev_priv,
956 struct kgsl_context *context,
957 struct kgsl_ibdesc *ibdesc,
958 unsigned int numibs,
959 uint32_t *timestamp,
960 unsigned int flags)
961{
962 struct kgsl_device *device = dev_priv->device;
963 struct adreno_device *adreno_dev = ADRENO_DEVICE(device);
Jordan Crouse72bb70b2013-05-28 17:03:52 -0600964 unsigned int *link = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700965 unsigned int *cmds;
966 unsigned int i;
Jordan Crouse72bb70b2013-05-28 17:03:52 -0600967 struct adreno_context *drawctxt = NULL;
Vijay Krishnamoorthybef66932012-01-24 09:32:05 -0700968 unsigned int start_index = 0;
Jordan Crouse2d1d6622013-05-28 17:02:44 -0600969 int ret = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700970
Jordan Crouse72bb70b2013-05-28 17:03:52 -0600971 if (device->state & KGSL_STATE_HUNG) {
972 ret = -EBUSY;
973 goto done;
974 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700975
Jordan Crouse72bb70b2013-05-28 17:03:52 -0600976 if (!(adreno_dev->ringbuffer.flags & KGSL_FLAGS_STARTED) ||
977 context == NULL || ibdesc == 0 || numibs == 0) {
978 ret = -EINVAL;
979 goto done;
980 }
Jeremy Gebben3c127f52011-08-08 17:04:11 -0600981 drawctxt = context->devctxt;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700982
983 if (drawctxt->flags & CTXT_FLAGS_GPU_HANG) {
Tarun Karra696f89e2013-01-27 21:31:40 -0800984 KGSL_CTXT_ERR(device, "proc %s failed fault tolerance"
Carter Cooper7e7f02e2012-02-15 09:36:31 -0700985 " will not accept commands for context %d\n",
Tarun Karra696f89e2013-01-27 21:31:40 -0800986 drawctxt->pid_name, drawctxt->id);
Jordan Crouse72bb70b2013-05-28 17:03:52 -0600987 ret = -EDEADLK;
988 goto done;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700989 }
Shubhraprakash Dasd23ff4b2012-04-05 16:55:54 -0600990
Tarun Karradeeecc02013-01-21 23:42:17 -0800991 if (drawctxt->flags & CTXT_FLAGS_SKIP_EOF) {
992 KGSL_CTXT_ERR(device,
Tarun Karra696f89e2013-01-27 21:31:40 -0800993 "proc %s triggered fault tolerance"
Tarun Karradeeecc02013-01-21 23:42:17 -0800994 " skipping commands for context till EOF %d\n",
Tarun Karra696f89e2013-01-27 21:31:40 -0800995 drawctxt->pid_name, drawctxt->id);
Tarun Karradeeecc02013-01-21 23:42:17 -0800996 if (flags & KGSL_CMD_FLAGS_EOF)
997 drawctxt->flags &= ~CTXT_FLAGS_SKIP_EOF;
998 numibs = 0;
999 }
1000
Shubhraprakash Dasd23ff4b2012-04-05 16:55:54 -06001001 cmds = link = kzalloc(sizeof(unsigned int) * (numibs * 3 + 4),
1002 GFP_KERNEL);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001003 if (!link) {
Jordan Crouse72bb70b2013-05-28 17:03:52 -06001004 ret = -ENOMEM;
1005 goto done;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001006 }
Vijay Krishnamoorthybef66932012-01-24 09:32:05 -07001007
1008 /*When preamble is enabled, the preamble buffer with state restoration
1009 commands are stored in the first node of the IB chain. We can skip that
1010 if a context switch hasn't occured */
1011
1012 if (drawctxt->flags & CTXT_FLAGS_PREAMBLE &&
1013 adreno_dev->drawctxt_active == drawctxt)
1014 start_index = 1;
1015
Shubhraprakash Dasd23ff4b2012-04-05 16:55:54 -06001016 if (!start_index) {
1017 *cmds++ = cp_nop_packet(1);
1018 *cmds++ = KGSL_START_OF_IB_IDENTIFIER;
1019 } else {
1020 *cmds++ = cp_nop_packet(4);
1021 *cmds++ = KGSL_START_OF_IB_IDENTIFIER;
1022 *cmds++ = CP_HDR_INDIRECT_BUFFER_PFD;
1023 *cmds++ = ibdesc[0].gpuaddr;
1024 *cmds++ = ibdesc[0].sizedwords;
1025 }
Vijay Krishnamoorthybef66932012-01-24 09:32:05 -07001026 for (i = start_index; i < numibs; i++) {
Jeremy Gebbend0ab6ad2012-04-06 11:13:35 -06001027 if (unlikely(adreno_dev->ib_check_level >= 1 &&
1028 !_parse_ibs(dev_priv, ibdesc[i].gpuaddr,
1029 ibdesc[i].sizedwords))) {
Jordan Crouse2d1d6622013-05-28 17:02:44 -06001030 ret = -EINVAL;
1031 goto done;
Jeremy Gebbend0ab6ad2012-04-06 11:13:35 -06001032 }
Jordan Crouse2d1d6622013-05-28 17:02:44 -06001033
1034 if (ibdesc[i].sizedwords == 0) {
1035 ret = -EINVAL;
1036 goto done;
1037 }
1038
Jordan Crouse084427d2011-07-28 08:37:58 -06001039 *cmds++ = CP_HDR_INDIRECT_BUFFER_PFD;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001040 *cmds++ = ibdesc[i].gpuaddr;
1041 *cmds++ = ibdesc[i].sizedwords;
1042 }
1043
Shubhraprakash Dasd23ff4b2012-04-05 16:55:54 -06001044 *cmds++ = cp_nop_packet(1);
1045 *cmds++ = KGSL_END_OF_IB_IDENTIFIER;
1046
Shubhraprakash Dasb2abc452012-06-08 16:33:03 -06001047 kgsl_setstate(&device->mmu, context->id,
Shubhraprakash Das767fdda2011-08-15 15:49:45 -06001048 kgsl_mmu_pt_get_flags(device->mmu.hwpagetable,
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001049 device->id));
1050
1051 adreno_drawctxt_switch(adreno_dev, drawctxt, flags);
1052
Carter Cooper9cf77b62013-05-28 17:04:26 -06001053 if (drawctxt->flags & CTXT_FLAGS_USER_GENERATED_TS) {
1054 if (timestamp_cmp(drawctxt->timestamp, *timestamp) >= 0) {
1055 KGSL_DRV_ERR(device,
1056 "Invalid user generated ts <%d:0x%x>, "
1057 "less than last issued ts <%d:0x%x>\n",
1058 drawctxt->id, *timestamp, drawctxt->id,
1059 drawctxt->timestamp);
1060 return -ERANGE;
1061 }
1062 drawctxt->timestamp = *timestamp;
1063 } else
1064 drawctxt->timestamp++;
1065
1066 ret = adreno_ringbuffer_addcmds(&adreno_dev->ringbuffer,
Vijay Krishnamoorthye80c3462012-08-27 14:07:32 -07001067 drawctxt,
Tarun Karradeeecc02013-01-21 23:42:17 -08001068 (flags & KGSL_CMD_FLAGS_EOF),
Carter Cooper9cf77b62013-05-28 17:04:26 -06001069 &link[0], (cmds - link));
1070 if (ret)
1071 goto done;
1072
1073 if (drawctxt->flags & CTXT_FLAGS_PER_CONTEXT_TS)
1074 *timestamp = drawctxt->timestamp;
1075 else
1076 *timestamp = adreno_dev->ringbuffer.global_ts;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001077
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001078#ifdef CONFIG_MSM_KGSL_CFF_DUMP
1079 /*
1080 * insert wait for idle after every IB1
1081 * this is conservative but works reliably and is ok
1082 * even for performance simulations
1083 */
Jordan Crousea29a2e02012-08-14 09:09:23 -06001084 adreno_idle(device);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001085#endif
Tarun Karradeeecc02013-01-21 23:42:17 -08001086
Tarun Karrad20d71a2013-01-25 15:38:57 -08001087 /*
1088 * If context hung and recovered then return error so that the
1089 * application may handle it
1090 */
1091 if (drawctxt->flags & CTXT_FLAGS_GPU_HANG_FT) {
1092 drawctxt->flags &= ~CTXT_FLAGS_GPU_HANG_FT;
Jordan Crouse2d1d6622013-05-28 17:02:44 -06001093 ret = -EPROTO;
1094 }
1095
1096done:
Jordan Crouse72bb70b2013-05-28 17:03:52 -06001097 trace_kgsl_issueibcmds(device, context->id, ibdesc, numibs,
1098 *timestamp, flags, ret, drawctxt->type);
1099
Jordan Crouse2d1d6622013-05-28 17:02:44 -06001100 kfree(link);
1101 return ret;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001102}
1103
Shubhraprakash Das2a85f1f2012-06-04 17:01:39 -06001104static void _turn_preamble_on_for_ib_seq(struct adreno_ringbuffer *rb,
1105 unsigned int rb_rptr)
1106{
1107 unsigned int temp_rb_rptr = rb_rptr;
1108 unsigned int size = rb->buffer_desc.size;
1109 unsigned int val[2];
1110 int i = 0;
1111 bool check = false;
1112 bool cmd_start = false;
1113
1114 /* Go till the start of the ib sequence and turn on preamble */
1115 while (temp_rb_rptr / sizeof(unsigned int) != rb->wptr) {
1116 kgsl_sharedmem_readl(&rb->buffer_desc, &val[i], temp_rb_rptr);
1117 if (check && KGSL_START_OF_IB_IDENTIFIER == val[i]) {
1118 /* decrement i */
1119 i = (i + 1) % 2;
1120 if (val[i] == cp_nop_packet(4)) {
1121 temp_rb_rptr = adreno_ringbuffer_dec_wrapped(
1122 temp_rb_rptr, size);
1123 kgsl_sharedmem_writel(&rb->buffer_desc,
1124 temp_rb_rptr, cp_nop_packet(1));
1125 }
Tarun Karrad20d71a2013-01-25 15:38:57 -08001126 KGSL_FT_INFO(rb->device,
Shubhraprakash Das2a85f1f2012-06-04 17:01:39 -06001127 "Turned preamble on at offset 0x%x\n",
1128 temp_rb_rptr / 4);
1129 break;
1130 }
1131 /* If you reach beginning of next command sequence then exit
1132 * First command encountered is the current one so don't break
1133 * on that. */
1134 if (KGSL_CMD_IDENTIFIER == val[i]) {
1135 if (cmd_start)
1136 break;
1137 cmd_start = true;
1138 }
1139
1140 i = (i + 1) % 2;
1141 if (1 == i)
1142 check = true;
1143 temp_rb_rptr = adreno_ringbuffer_inc_wrapped(temp_rb_rptr,
1144 size);
1145 }
1146}
1147
Shubhraprakash Das460cc762013-01-16 16:57:46 -08001148void adreno_ringbuffer_extract(struct adreno_ringbuffer *rb,
Tarun Karrad20d71a2013-01-25 15:38:57 -08001149 struct adreno_ft_data *ft_data)
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001150{
Shubhraprakash Das460cc762013-01-16 16:57:46 -08001151 struct kgsl_device *device = rb->device;
Tarun Karrad20d71a2013-01-25 15:38:57 -08001152 unsigned int rb_rptr = ft_data->start_of_replay_cmds;
Tarun Karradeeecc02013-01-21 23:42:17 -08001153 unsigned int good_rb_idx = 0, bad_rb_idx = 0, temp_rb_idx = 0;
1154 unsigned int last_good_cmd_end_idx = 0, last_bad_cmd_end_idx = 0;
1155 unsigned int cmd_start_idx = 0;
1156 unsigned int val1 = 0;
1157 int copy_rb_contents = 0;
1158 unsigned int temp_rb_rptr;
1159 struct kgsl_context *k_ctxt;
1160 struct adreno_context *a_ctxt;
1161 unsigned int size = rb->buffer_desc.size;
Tarun Karrad20d71a2013-01-25 15:38:57 -08001162 unsigned int *temp_rb_buffer = ft_data->rb_buffer;
1163 int *rb_size = &ft_data->rb_size;
1164 unsigned int *bad_rb_buffer = ft_data->bad_rb_buffer;
1165 int *bad_rb_size = &ft_data->bad_rb_size;
1166 unsigned int *good_rb_buffer = ft_data->good_rb_buffer;
1167 int *good_rb_size = &ft_data->good_rb_size;
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001168
Shubhraprakash Das460cc762013-01-16 16:57:46 -08001169 /*
1170 * If the start index from where commands need to be copied is invalid
1171 * then no need to save off any commands
1172 */
Tarun Karrad20d71a2013-01-25 15:38:57 -08001173 if (0xFFFFFFFF == ft_data->start_of_replay_cmds)
Shubhraprakash Das460cc762013-01-16 16:57:46 -08001174 return;
1175
Jordan Crouse67db48d2013-05-28 17:04:17 -06001176 k_ctxt = kgsl_context_get(device, ft_data->context_id);
1177
Shubhraprakash Das460cc762013-01-16 16:57:46 -08001178 if (k_ctxt) {
1179 a_ctxt = k_ctxt->devctxt;
1180 if (a_ctxt->flags & CTXT_FLAGS_PREAMBLE)
1181 _turn_preamble_on_for_ib_seq(rb, rb_rptr);
Jordan Crouse67db48d2013-05-28 17:04:17 -06001182 kgsl_context_put(k_ctxt);
Shubhraprakash Das460cc762013-01-16 16:57:46 -08001183 }
1184 k_ctxt = NULL;
1185
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001186 /* Walk the rb from the context switch. Omit any commands
1187 * for an invalid context. */
1188 while ((rb_rptr / sizeof(unsigned int)) != rb->wptr) {
1189 kgsl_sharedmem_readl(&rb->buffer_desc, &val1, rb_rptr);
1190
1191 if (KGSL_CMD_IDENTIFIER == val1) {
1192 /* Start is the NOP dword that comes before
1193 * KGSL_CMD_IDENTIFIER */
Tarun Karradeeecc02013-01-21 23:42:17 -08001194 cmd_start_idx = temp_rb_idx - 1;
1195 if ((copy_rb_contents) && (good_rb_idx))
1196 last_good_cmd_end_idx = good_rb_idx - 1;
1197 if ((!copy_rb_contents) && (bad_rb_idx))
1198 last_bad_cmd_end_idx = bad_rb_idx - 1;
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001199 }
1200
1201 /* check for context switch indicator */
1202 if (val1 == KGSL_CONTEXT_TO_MEM_IDENTIFIER) {
1203 unsigned int temp_idx, val2;
1204 /* increment by 3 to get to the context_id */
1205 temp_rb_rptr = rb_rptr + (3 * sizeof(unsigned int)) %
1206 size;
1207 kgsl_sharedmem_readl(&rb->buffer_desc, &val2,
1208 temp_rb_rptr);
1209
1210 /* if context switches to a context that did not cause
1211 * hang then start saving the rb contents as those
1212 * commands can be executed */
Jordan Crouse67db48d2013-05-28 17:04:17 -06001213 k_ctxt = kgsl_context_get(rb->device, val2);
1214
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001215 if (k_ctxt) {
1216 a_ctxt = k_ctxt->devctxt;
1217
1218 /* If we are changing to a good context and were not
1219 * copying commands then copy over commands to the good
1220 * context */
1221 if (!copy_rb_contents && ((k_ctxt &&
1222 !(a_ctxt->flags & CTXT_FLAGS_GPU_HANG)) ||
1223 !k_ctxt)) {
1224 for (temp_idx = cmd_start_idx;
Tarun Karradeeecc02013-01-21 23:42:17 -08001225 temp_idx < temp_rb_idx;
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001226 temp_idx++)
Tarun Karradeeecc02013-01-21 23:42:17 -08001227 good_rb_buffer[good_rb_idx++] =
1228 temp_rb_buffer[temp_idx];
Tarun Karrad20d71a2013-01-25 15:38:57 -08001229 ft_data->last_valid_ctx_id = val2;
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001230 copy_rb_contents = 1;
Tarun Karradeeecc02013-01-21 23:42:17 -08001231 /* remove the good commands from bad buffer */
1232 bad_rb_idx = last_bad_cmd_end_idx;
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001233 } else if (copy_rb_contents && k_ctxt &&
1234 (a_ctxt->flags & CTXT_FLAGS_GPU_HANG)) {
Tarun Karradeeecc02013-01-21 23:42:17 -08001235
1236 /* If we are changing back to a bad context
1237 * from good ctxt and were not copying commands
1238 * to bad ctxt then copy over commands to
1239 * the bad context */
1240 for (temp_idx = cmd_start_idx;
1241 temp_idx < temp_rb_idx;
1242 temp_idx++)
1243 bad_rb_buffer[bad_rb_idx++] =
1244 temp_rb_buffer[temp_idx];
1245 /* If we are changing to bad context then
1246 * remove the dwords we copied for this
1247 * sequence from the good buffer */
1248 good_rb_idx = last_good_cmd_end_idx;
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001249 copy_rb_contents = 0;
1250 }
1251 }
Jordan Crouse67db48d2013-05-28 17:04:17 -06001252 kgsl_context_put(k_ctxt);
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001253 }
1254
1255 if (copy_rb_contents)
Tarun Karradeeecc02013-01-21 23:42:17 -08001256 good_rb_buffer[good_rb_idx++] = val1;
1257 else
1258 bad_rb_buffer[bad_rb_idx++] = val1;
1259
1260 /* Copy both good and bad commands to temp buffer */
1261 temp_rb_buffer[temp_rb_idx++] = val1;
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001262
1263 rb_rptr = adreno_ringbuffer_inc_wrapped(rb_rptr, size);
1264 }
Tarun Karradeeecc02013-01-21 23:42:17 -08001265 *good_rb_size = good_rb_idx;
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001266 *bad_rb_size = bad_rb_idx;
Tarun Karradeeecc02013-01-21 23:42:17 -08001267 *rb_size = temp_rb_idx;
Shubhraprakash Das1d577fe2012-05-31 18:28:22 -06001268}
1269
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07001270void
1271adreno_ringbuffer_restore(struct adreno_ringbuffer *rb, unsigned int *rb_buff,
1272 int num_rb_contents)
1273{
1274 int i;
1275 unsigned int *ringcmds;
1276 unsigned int rcmd_gpu;
1277
1278 if (!num_rb_contents)
1279 return;
1280
1281 if (num_rb_contents > (rb->buffer_desc.size - rb->wptr)) {
1282 adreno_regwrite(rb->device, REG_CP_RB_RPTR, 0);
1283 rb->rptr = 0;
1284 BUG_ON(num_rb_contents > rb->buffer_desc.size);
1285 }
1286 ringcmds = (unsigned int *)rb->buffer_desc.hostptr + rb->wptr;
1287 rcmd_gpu = rb->buffer_desc.gpuaddr + sizeof(unsigned int) * rb->wptr;
1288 for (i = 0; i < num_rb_contents; i++)
1289 GSL_RB_WRITE(ringcmds, rcmd_gpu, rb_buff[i]);
1290 rb->wptr += num_rb_contents;
1291 adreno_ringbuffer_submit(rb);
1292}