348 lines
7.3 KiB
C
348 lines
7.3 KiB
C
|
|
#include <drmP.h>
|
|
#include <drm.h>
|
|
#include "i915_drm.h"
|
|
#include "i915_drv.h"
|
|
#include "intel_drv.h"
|
|
#include "bitmap.h"
|
|
|
|
#define memmove __builtin_memmove
|
|
|
|
int gem_object_lock(struct drm_i915_gem_object *obj);
|
|
|
|
#define DRIVER_CAPS_0 HW_BIT_BLIT | HW_TEX_BLIT;
|
|
#define DRIVER_CAPS_1 0
|
|
|
|
extern struct drm_device *main_device;
|
|
|
|
struct hman bm_man;
|
|
|
|
void __attribute__((regparm(1))) destroy_bitmap(bitmap_t *bitmap)
|
|
{
|
|
printf("destroy bitmap %d\n", bitmap->handle);
|
|
free_handle(&bm_man, bitmap->handle);
|
|
bitmap->handle = 0;
|
|
bitmap->obj->base.read_domains = I915_GEM_DOMAIN_GTT;
|
|
bitmap->obj->base.write_domain = I915_GEM_DOMAIN_CPU;
|
|
|
|
mutex_lock(&main_device->struct_mutex);
|
|
drm_gem_object_unreference(&bitmap->obj->base);
|
|
mutex_unlock(&main_device->struct_mutex);
|
|
|
|
__DestroyObject(bitmap);
|
|
};
|
|
|
|
int init_bitmaps()
|
|
{
|
|
int ret;
|
|
|
|
ret = init_hman(&bm_man, 1024);
|
|
|
|
return ret;
|
|
};
|
|
|
|
|
|
int create_surface(struct io_call_10 *pbitmap)
|
|
{
|
|
struct drm_i915_gem_object *obj;
|
|
|
|
bitmap_t *bitmap;
|
|
u32 handle;
|
|
u32 width, max_width;
|
|
u32 height, max_height;
|
|
u32 size, max_size;
|
|
u32 pitch, max_pitch;
|
|
void *uaddr;
|
|
|
|
int ret;
|
|
|
|
pbitmap->handle = 0;
|
|
pbitmap->data = (void*)-1;
|
|
|
|
width = pbitmap->width;
|
|
height = pbitmap->height;
|
|
|
|
/*
|
|
if((width==0)||(height==0)||(width>4096)||(height>4096))
|
|
goto err1;
|
|
|
|
if( ((pbitmap->max_width !=0 ) &&
|
|
(pbitmap->max_width < width)) ||
|
|
(pbitmap->max_width > 4096) )
|
|
goto err1;
|
|
|
|
if( ((pbitmap->max_height !=0 ) &&
|
|
(pbitmap->max_height < width)) ||
|
|
(pbitmap->max_height > 4096) )
|
|
goto err1;
|
|
|
|
if( pbitmap->format != 0)
|
|
goto err1;
|
|
*/
|
|
|
|
max_width = (pbitmap->max_width ==0) ? width : pbitmap->max_width;
|
|
max_height = (pbitmap->max_height==0) ? height : pbitmap->max_height;
|
|
|
|
handle = alloc_handle(&bm_man);
|
|
// printf("%s %d\n",__FUNCTION__, handle);
|
|
|
|
if(handle == 0)
|
|
goto err1;
|
|
|
|
bitmap = CreateObject(GetPid(), sizeof(*bitmap));
|
|
bitmap->handle = handle;
|
|
bitmap->header.destroy = destroy_bitmap;
|
|
bitmap->obj = NULL;
|
|
|
|
// printf("bitmap %x\n", bitmap);
|
|
if( bitmap == NULL)
|
|
goto err1;
|
|
|
|
hman_set_data(&bm_man, handle, bitmap);
|
|
|
|
pitch = ALIGN(width*4,64);
|
|
|
|
size = roundup(pitch*height, PAGE_SIZE);
|
|
|
|
// printf("pitch %d size %d\n", pitch, size);
|
|
|
|
obj = i915_gem_alloc_object(main_device, size);
|
|
if (obj == NULL)
|
|
goto err2;
|
|
|
|
ret = i915_gem_object_pin(obj, 4096, true);
|
|
if (ret)
|
|
goto err3;
|
|
|
|
max_pitch = ALIGN(max_width*4,64);
|
|
max_size = roundup(max_pitch*max_height, PAGE_SIZE);
|
|
|
|
uaddr = UserAlloc(max_size);
|
|
if( uaddr == NULL)
|
|
goto err4;
|
|
else
|
|
{
|
|
u32_t *src, *dst;
|
|
u32 count, max_count;
|
|
|
|
#define page_tabs 0xFDC00000 /* really dirty hack */
|
|
|
|
src = (u32_t*)obj->pages;
|
|
dst = &((u32_t*)page_tabs)[(u32_t)uaddr >> 12];
|
|
count = size/4096;
|
|
max_count = max_size/4096 - count;
|
|
|
|
while(count--)
|
|
{
|
|
*dst++ = (0xFFFFF000 & *src++) | 0x207 ; // map as shared page
|
|
};
|
|
while(max_count--)
|
|
*dst++ = 0; // cleanup unused space
|
|
}
|
|
|
|
obj->mapped = uaddr ;
|
|
|
|
bitmap->handle = handle;
|
|
bitmap->uaddr = uaddr;
|
|
bitmap->pitch = pitch;
|
|
bitmap->gaddr = obj->gtt_offset;
|
|
|
|
bitmap->width = width;
|
|
bitmap->height = height;
|
|
bitmap->max_width = max_width;
|
|
bitmap->max_height = max_height;
|
|
|
|
bitmap->obj = obj;
|
|
bitmap->header.destroy = destroy_bitmap;
|
|
|
|
pbitmap->handle = handle;
|
|
pbitmap->data = uaddr;
|
|
pbitmap->pitch = pitch;
|
|
|
|
|
|
printf("%s handle: %d pitch: %d gpu_addr: %x user_addr: %x\n",
|
|
__FUNCTION__, handle, pitch, obj->gtt_offset, uaddr);
|
|
|
|
return 0;
|
|
|
|
err4:
|
|
i915_gem_object_unpin(obj);
|
|
err3:
|
|
drm_gem_object_unreference(&obj->base);
|
|
err2:
|
|
free_handle(&bm_man, handle);
|
|
__DestroyObject(bitmap);
|
|
err1:
|
|
return -1;
|
|
|
|
};
|
|
|
|
|
|
int lock_surface(struct io_call_12 *pbitmap)
|
|
{
|
|
int ret;
|
|
|
|
drm_i915_private_t *dev_priv = main_device->dev_private;
|
|
|
|
bitmap_t *bitmap;
|
|
|
|
if(unlikely(pbitmap->handle == 0))
|
|
return -1;
|
|
|
|
bitmap = (bitmap_t*)hman_get_data(&bm_man, pbitmap->handle);
|
|
|
|
if(unlikely(bitmap==NULL))
|
|
return -1;
|
|
|
|
ret = gem_object_lock(bitmap->obj);
|
|
if(ret !=0 )
|
|
{
|
|
pbitmap->data = NULL;
|
|
pbitmap->pitch = 0;
|
|
|
|
dbgprintf("%s fail\n", __FUNCTION__);
|
|
return ret;
|
|
};
|
|
|
|
pbitmap->data = bitmap->uaddr;
|
|
pbitmap->pitch = bitmap->pitch;
|
|
|
|
return 0;
|
|
};
|
|
|
|
int init_hman(struct hman *man, u32 count)
|
|
{
|
|
u32* data;
|
|
|
|
data = malloc(count*sizeof(u32*));
|
|
if(data)
|
|
{
|
|
int i;
|
|
|
|
for(i=0;i < count-1;)
|
|
data[i] = ++i;
|
|
data[i] = 0;
|
|
|
|
man->table = data;
|
|
man->next = 0;
|
|
man->avail = count;
|
|
man->count = count;
|
|
|
|
return 0;
|
|
};
|
|
return -ENOMEM;
|
|
};
|
|
|
|
u32 alloc_handle(struct hman *man)
|
|
{
|
|
u32 handle = 0;
|
|
|
|
if(man->avail)
|
|
{
|
|
handle = man->next;
|
|
man->next = man->table[handle];
|
|
man->avail--;
|
|
handle++;
|
|
}
|
|
return handle;
|
|
};
|
|
|
|
int free_handle(struct hman *man, u32 handle)
|
|
{
|
|
int ret = -1;
|
|
|
|
handle--;
|
|
|
|
if(handle < man->count)
|
|
{
|
|
man->table[handle] = man->next;
|
|
man->next = handle;
|
|
man->avail++;
|
|
ret = 0;
|
|
};
|
|
|
|
return ret;
|
|
};
|
|
|
|
|
|
void *drm_intel_bo_map(struct drm_i915_gem_object *obj, int write_enable)
|
|
{
|
|
u8 *kaddr;
|
|
|
|
kaddr = AllocKernelSpace(obj->base.size);
|
|
if( kaddr != NULL)
|
|
{
|
|
u32_t *src = (u32_t*)obj->pages;
|
|
u32_t *dst = &((u32_t*)page_tabs)[(u32_t)kaddr >> 12];
|
|
|
|
u32 count = obj->base.size/4096;
|
|
|
|
while(count--)
|
|
{
|
|
*dst++ = (0xFFFFF000 & *src++) | 0x003 ;
|
|
};
|
|
return kaddr;
|
|
};
|
|
return NULL;
|
|
}
|
|
|
|
void destroy_gem_object(uint32_t handle)
|
|
{
|
|
struct drm_i915_gem_object *obj = (void*)handle;
|
|
drm_gem_object_unreference(&obj->base);
|
|
|
|
};
|
|
|
|
|
|
void write_gem_object(uint32_t handle, u32 offset, u32 size, u8* src)
|
|
{
|
|
struct drm_i915_gem_object *obj = (void*)handle;
|
|
u8 *dst;
|
|
int ret;
|
|
|
|
ret = i915_gem_object_pin(obj, 4096, true);
|
|
if (ret)
|
|
return;
|
|
|
|
dst = drm_intel_bo_map(obj, true);
|
|
if( dst != NULL )
|
|
{
|
|
memmove(dst+offset, src, size);
|
|
FreeKernelSpace(dst);
|
|
};
|
|
};
|
|
|
|
u32 get_buffer_offset(uint32_t handle)
|
|
{
|
|
struct drm_i915_gem_object *obj = (void*)handle;
|
|
|
|
return obj->gtt_offset;
|
|
};
|
|
|
|
|
|
int get_driver_caps(hwcaps_t *caps)
|
|
{
|
|
int ret = 0;
|
|
ENTER();
|
|
|
|
dbgprintf("caps ptr %x\n", caps);
|
|
|
|
switch(caps->idx)
|
|
{
|
|
case 0:
|
|
caps->opt[0] = DRIVER_CAPS_0;
|
|
caps->opt[1] = DRIVER_CAPS_1;
|
|
break;
|
|
|
|
case 1:
|
|
caps->cap1.max_tex_width = 4096;
|
|
caps->cap1.max_tex_height = 4096;
|
|
break;
|
|
default:
|
|
ret = 1;
|
|
};
|
|
caps->idx = 1;
|
|
return ret;
|
|
}
|
|
|