uint8_t* OmapFramebuffer::map(unsigned plane)
{
FramebufferPlane& p = m_planes[plane];
if (p.map)
return p.map;
p.map = (uint8_t*)omap_bo_map(p.omap_bo);
if (p.map == MAP_FAILED)
throw invalid_argument(string("mmap failed: ") + strerror(errno));
return p.map;
}
static int callCompute_Linux()
{
Mx_Compute *compute = NULL;
int drmFd = 0;
struct omap_device *dev = NULL;
struct omap_bo *compute_bo = NULL;
struct omap_bo *inBuf_bo = NULL;
struct omap_bo *outBuf_bo = NULL;
uint32_t * inBufPtr = NULL;
uint32_t * outBufPtr = NULL;
int status = 0;
int size;
uint32_t val;
int i;
int32_t ret;
/* On Linux, use omapdrm driver to get a Tiler buffer for shared memory */
drmFd = drmOpen("omapdrm", NULL);
if (drmFd < 0) {
fprintf(stderr, "could not open omapdrm device: %d: %s\n",
errno, strerror(errno));
return 1;
}
dev = omap_device_new(drmFd);
if (!dev) {
fprintf(stderr, "could not get device from fd\n");
goto leave;
}
/* allocate a compute structure in shared memory and get a pointer */
compute_bo = omap_bo_new(dev, sizeof(Mx_Compute), OMAP_BO_CACHED);
if (compute_bo) {
compute = (Mx_Compute *)omap_bo_map(compute_bo);
}
else {
fprintf(stderr, "failed to allocate omap_bo\n");
}
if (compute == NULL) {
fprintf(stderr, "failed to map omap_bo to user space\n");
goto leave;
}
/* initialize compute structure */
compute->coef = 0x80400000;
compute->key = 0xABA0;
compute->size = 0x1000;
compute->inBuf = NULL;
compute->outBuf = NULL;
/* allocate an input buffer in shared memory */
size = compute->size * sizeof(uint32_t);
inBuf_bo = omap_bo_new(dev, size, OMAP_BO_CACHED);
if (inBuf_bo) {
inBufPtr = (uint32_t *)omap_bo_map(inBuf_bo);
}
else {
fprintf(stderr, "failed to allocate inBuf_bo\n");
}
if (inBufPtr == NULL) {
printf("mmrpc_test: Error: inBufPtr == NULL\n");
status = -1;
goto leave;
}
/* fill input buffer with seed value */
for (i = 0; i < compute->size; i++) {
inBufPtr[i] = 0x2010;
}
/* allocate an output buffer in shared memory */
outBuf_bo = omap_bo_new(dev, size, OMAP_BO_CACHED);
if (outBuf_bo) {
outBufPtr = (uint32_t *)omap_bo_map(outBuf_bo);
}
else {
fprintf(stderr, "failed to allocate outBuf_bo handle\n");
}
if (outBufPtr == NULL) {
printf("mmrpc_test: Error: outBufPtr == NULL\n");
status = -1;
goto leave;
}
/* clear output buffer */
for (i = 0; i < compute->size; i++) {
outBufPtr[i] = 0;
}
compute->inBuf = (uint32_t *)inBufPtr;
compute->outBuf = (uint32_t *)outBufPtr;
/* print some debug info */
printf("mmrpc_test: calling Mx_compute(0x%x)\n", (unsigned int)compute);
printf("mmrpc_test: compute->coef=0x%x\n", compute->coef);
printf("mmrpc_test: compute->key=0x%x\n", compute->key);
printf("mmrpc_test: compute->size=0x%x\n", compute->size);
printf("mmrpc_test: compute->inBuf=0x%x\n", (unsigned int)compute->inBuf);
printf("mmrpc_test: compute->outBuf=0x%x\n", (unsigned int)compute->outBuf);
/* process the buffer */
ret = Mx_compute_Linux(compute, omap_bo_dmabuf(compute_bo),
omap_bo_dmabuf(inBuf_bo),
omap_bo_dmabuf(outBuf_bo));
if (ret < 0) {
status = -1;
printf("mmrpc_test: Error: Mx_Compute() failed\n");
goto leave;
}
printf("mmrpc_test: after Mx_compute(0x%x)\n", (unsigned int)compute);
printf("mmrpc_test: compute->coef=0x%x\n", compute->coef);
printf("mmrpc_test: compute->key=0x%x\n", compute->key);
printf("mmrpc_test: compute->size=0x%x\n", compute->size);
printf("mmrpc_test: compute->inBuf=0x%x\n", (unsigned int)compute->inBuf);
printf("mmrpc_test: compute->outBuf=0x%x\n", (unsigned int)compute->outBuf);
printf("mmrpc_test: compute->inBuf[0]=0x%x\n",
(unsigned int)compute->inBuf[0]);
printf("mmrpc_test: compute->outBuf[0]=0x%x\n",
(unsigned int)compute->outBuf[0]);
/* check the output buffer */
for (i = 0; i < compute->size; i++) {
val = outBufPtr[i] | compute->coef;
if (outBufPtr[i] != val) {
status = -1;
printf("mmrpc_test: Error: incorrect outBuf\n");
break;
}
}
leave:
if (outBuf_bo) {
omap_bo_del(outBuf_bo);
}
if (inBuf_bo) {
omap_bo_del(inBuf_bo);
}
if (compute_bo) {
omap_bo_del(compute_bo);
}
if (dev) {
omap_device_del(dev);
}
if (drmFd) {
close(drmFd);
}
return (status);
}
void *
capture_loop(void *arg)
{
struct thr_data *data = (struct thr_data *)arg;
struct display *disp = data->disp;
struct v4l2 *v4l2 = data->v4l2;
uint32_t fourcc = data->fourcc;
uint32_t width = data->width, height = data->height;
struct buffer **buffers, *capt, *alg, **alg_bufs;
int ret, i;
int *src, *dst;
int w, h;
buffers = disp_get_vid_buffers(disp, NBUF, fourcc, width, height);
if (!buffers) {
return NULL;
}
alg_bufs = disp_get_vid_buffers(disp, 1, fourcc, width, height);
alg = alg_bufs[0];
ret = v4l2_reqbufs(v4l2, buffers, NBUF);
if (ret) {
return NULL;
}
for (i = 0; i < NBUF; i++) {
v4l2_qbuf(v4l2, buffers[i]);
}
ret = v4l2_streamon(v4l2);
if (ret) {
return NULL;
}
for (i = 1; i < CNT; i++) {
capt = v4l2_dqbuf(v4l2);
src = omap_bo_map(capt->bo[0]);
dst = omap_bo_map(alg->bo[0]);
//printf("debug: %p %p\n", src, dst);
omap_bo_cpu_prep(capt->bo[0], OMAP_GEM_READ);
omap_bo_cpu_prep(alg->bo[0], OMAP_GEM_WRITE);
//printf("bufers prepared\n");
/*
for (h=0; h<720; h++)
for(w=0;w<1280 / 2;w++)
dst[h * 1280 / 2 + w] = src[h * 1280 / 2 + 1280 / 2 - w];
*/
printf("Calling get Image");
//getImage(dst);
//printf("Mirrrored\n");
omap_bo_cpu_fini(capt->bo[0], OMAP_GEM_READ);
omap_bo_cpu_fini(alg->bo[0], OMAP_GEM_WRITE);
ret = disp_post_vid_buffer(disp, alg,
0, 0, width, height);
//printf("Alg buffer posted\n");
ret = disp_post_vid_buffer(disp, capt,
0, 0, width, height);
if (ret) {
ERROR("Post buffer failed");
return NULL;
}
v4l2_qbuf(v4l2, capt);
}
v4l2_streamoff(v4l2);
MSG("Ok!");
return disp;
}