/* * Some defines to define the behavior of the program */ #define CLEAN_FBDEV #undef DEMO_CLONE #define SIZE_X 2048 #define SIZE_Y 2048 /* Pitch needs to be power of two */ #define PITCH 2048 #include #include #include #include #include #include #ifdef CLEAN_FBDEV #include #include #include #include #endif #include #include "xf86drm.h" #include "xf86drmMode.h" /* old functions to be replaced */ drmModeFBPtr createFB(int fd, drmModeResPtr res); void testCursor(int fd, uint32_t crtc); void prettyColors(int fd, unsigned int handle); void prettyCursor(int fd, unsigned int handle, unsigned int color); #ifdef CLEAN_FBDEV struct fb_var_screeninfo var; struct fb_fix_screeninfo fix; #endif /* structs for the demo_driver */ struct demo_driver; struct demo_screen { /* drm stuff */ drmBO buffer; drmModeFBPtr fb; drmModeCrtcPtr crtc; size_t num_outputs; uint32_t outputs_id[8]; drmModeOutputPtr outputs[8]; struct drm_mode_modeinfo *mode; /* virtual buffer */ uint32_t virt_x; uint32_t virt_y; uint32_t pitch; /* parent */ struct demo_driver *driver; }; #define DEMO_MAX_SCREENS 4 #define MAX_FIND_OUTPUTS 8 struct demo_driver { /* drm stuff */ int fd; drmModeResPtr res; /* screens */ size_t numScreens; struct demo_screen screens[DEMO_MAX_SCREENS]; }; struct demo_driver* demoCreateDriver(void); void demoUpdateRes(struct demo_driver *driver); int demoCreateScreens(struct demo_driver *driver); int demoCreateScreenCloned(struct demo_driver *driver); void demoTakeDownScreen(struct demo_screen *screen); int demoFindConnectedOutputs(struct demo_driver *driver, drmModeOutputPtr *out, size_t max_out); drmModeCrtcPtr demoFindFreeCrtc(struct demo_driver *driver, drmModeOutputPtr output); void demoPanScreen(struct demo_screen *screen, uint16_t x, uint16_t y); /* yet to be implemented */ void demoMouseActivate(struct demo_screen *screen); void demoMouseMove(struct demo_screen *screen, uint16_t x, uint16_t y); static struct drm_mode_modeinfo mode = { .name = "Test mode", .clock = 25200, .hdisplay = 640, .hsync_start = 656, .hsync_end = 752, .htotal = 800, .hskew = 0, .vdisplay = 480, .vsync_start = 490, .vsync_end = 492, .vtotal = 525, .vscan = 0, .vrefresh = 60000, /* vertical refresh * 1000 */ .flags = 10, }; int main(int argc, char **argv) { struct demo_driver *driver; int num; int i; #ifdef CLEAN_FBDEV int fbdev_fd; fbdev_fd = open("/dev/fb0", O_RDWR); memset(&var, 0, sizeof(struct fb_var_screeninfo)); memset(&fix, 0, sizeof(struct fb_fix_screeninfo)); if (ioctl(fbdev_fd, FBIOGET_VSCREENINFO, &var)) printf("var %s\n", strerror(errno)); if (ioctl(fbdev_fd, FBIOGET_FSCREENINFO, &fix)) printf("fix %s\n", strerror(errno)); #endif printf("starting demo\n"); driver = demoCreateDriver(); if (!driver) { printf("failed to create driver\n"); return 1; } #ifndef DEMO_CLONE num = demoCreateScreens(driver); #else num = demoCreateScreenCloned(driver); #endif if (num < 1) { printf("no screens attached or an error occured\n"); return 1; } printf("created %i screens\n", num); for (i = 0; i < num; i++) { prettyColors(driver->fd, driver->screens[i].fb->handle); } sleep(1); for (i = 0; i < num; i++) { printf("%i: 100 0\n", i); demoPanScreen(&driver->screens[i], 100, 0); sleep(1); printf("%i: 0 100\n", i); demoPanScreen(&driver->screens[i], 0, 100); sleep(1); printf("%i: 100 100\n", i); demoPanScreen(&driver->screens[i], 100, 100); sleep(1); printf("%i: 0 0\n", i); demoPanScreen(&driver->screens[i], 0, 1); sleep(1); testCursor(driver->fd, driver->screens[i].crtc->crtc_id); } sleep(2); printf("taking down screens\n"); for (i = 0; i < num; i++) { demoTakeDownScreen(&driver->screens[i]); } #ifdef CLEAN_FBDEV if (ioctl(fbdev_fd, FBIOPUT_VSCREENINFO, &var)) printf("var %s\n", strerror(errno)); close(fbdev_fd); #endif printf("ok\n"); return 0; } int demoCreateScreens(struct demo_driver *driver) { drmModeOutputPtr out[MAX_FIND_OUTPUTS]; int num; int num_screens = 0; struct demo_screen *screen; int ret = 0; int i; num = demoFindConnectedOutputs(driver, out, MAX_FIND_OUTPUTS); if (num < 0) return 0; printf("found %i connected outputs\n", num); for (i = 0; i < num; i++) { screen = &driver->screens[i]; screen->crtc = demoFindFreeCrtc(driver, out[i]); if (!screen->crtc) { printf("found no free crtc for output\n"); drmModeFreeOutput(out[i]); continue; } screen->fb = createFB(driver->fd, driver->res); if (!screen->fb) { drmModeFreeOutput(out[i]); drmModeFreeCrtc(screen->crtc); screen->crtc = 0; printf("could not create framebuffer\n"); continue; } screen->virt_x = SIZE_X; screen->virt_y = SIZE_Y; screen->pitch = PITCH; screen->outputs[0] = out[i]; screen->outputs_id[0] = out[i]->output_id; screen->num_outputs = 1; screen->mode = &mode; screen->driver = driver; ret = drmModeSetCrtc( driver->fd, screen->crtc->crtc_id, screen->fb->buffer_id, 0, 0, screen->outputs_id, screen->num_outputs, screen->mode); if (ret) { printf("failed to set mode\n"); demoTakeDownScreen(screen); } else { num_screens++; } demoUpdateRes(driver); } return num_screens; } int demoCreateScreenCloned(struct demo_driver *driver) { drmModeOutputPtr out[MAX_FIND_OUTPUTS]; int num; struct demo_screen *screen; int ret = 0; int i; num = demoFindConnectedOutputs(driver, out, MAX_FIND_OUTPUTS); if (num < 0) return 0; printf("found %i connected outputs\n", num); screen = &driver->screens[0]; screen->fb = createFB(driver->fd, driver->res); if (!screen->fb) { printf("could not create framebuffer\n"); return 0; } screen->mode = &mode; screen->driver = driver; screen->virt_x = SIZE_X; screen->virt_y = SIZE_Y; screen->pitch = PITCH; screen->num_outputs = 0; for (i = 0; i < num; i++) { screen->crtc = demoFindFreeCrtc(driver, out[i]); if (!screen->crtc) { printf("found no free crtc for output\n"); drmModeFreeOutput(out[i]); continue; } screen->outputs[screen->num_outputs] = out[i]; screen->outputs_id[screen->num_outputs] = out[i]->output_id; screen->num_outputs++; printf("%u, %u\n", out[i]->output_id, screen->num_outputs); } ret = drmModeSetCrtc( driver->fd, screen->crtc->crtc_id, screen->fb->buffer_id, 0, 0, screen->outputs_id, screen->num_outputs, screen->mode); if (ret) { printf("failed to set mode\n"); demoTakeDownScreen(screen); return 0; } demoUpdateRes(driver); return 1; } void demoTakeDownScreen(struct demo_screen *screen) { int fd = screen->driver->fd; int i; drmBO bo; #if 0 /* This can bust the fbdev arrangement as it basically unhooks * the outputs and the fbdev backend doesn't know how to put things * back on track. Realistically, it's up to the crtc owner to restore * things..... * * So if you are mixing API's make sure the modesetting owner puts * back the original CRTC arrangement so fbdev can continue... * * Ho-hum.. */ if (screen->crtc) drmModeSetCrtc(fd, screen->crtc->crtc_id, 0, 0, 0, 0, 0, 0); #endif if (screen->fb) drmModeRmFB(fd, screen->fb->buffer_id); /* maybe we should keep a pointer to the bo on the screen */ if (screen->fb && !drmBOReference(fd, screen->fb->handle, &bo)) { drmBOUnreference(fd, &bo); drmBOUnreference(fd, &bo); } else { printf("bo error\n"); } for (i = 0; i < screen->num_outputs; i++) { drmModeFreeOutput(screen->outputs[i]); screen->outputs[i] = NULL; } drmModeFreeCrtc(screen->crtc); drmModeFreeFB(screen->fb); screen->crtc = NULL; screen->fb = NULL; } drmModeCrtcPtr demoFindFreeCrtc(struct demo_driver *driver, drmModeOutputPtr output) { drmModeCrtcPtr crtc; int i, j, used = 0; drmModeResPtr res = driver->res; for (i = 0; i < res->count_crtcs; i++) { used = 0; for (j = 0; j < DEMO_MAX_SCREENS; j++) { crtc = driver->screens[j].crtc; if (crtc && crtc->crtc_id == res->crtcs[i]) used = 1; } if (!used) { crtc = drmModeGetCrtc(driver->fd, res->crtcs[i]); break; } else { crtc = 0; } } return crtc; } static int driverfd; static void hotplugSIGNAL(int sig, siginfo_t *si, void *d) { union drm_wait_hotplug hw; int ret; printf("GOT HOTPLUG EVENT!\n"); /* ask for another hotplug event ! */ memset(&hw, 0, sizeof(hw)); hw.request.type = _DRM_HOTPLUG_SIGNAL; hw.request.signal = SIGUSR1; ret = ioctl(driverfd, DRM_IOCTL_WAIT_HOTPLUG, &hw); } struct demo_driver* demoCreateDriver(void) { struct demo_driver* driver = malloc(sizeof(struct demo_driver)); union drm_wait_hotplug hw; int ret = 0; memset(driver, 0, sizeof(struct demo_driver)); driver->fd = drmOpen("i915",NULL); if (driver->fd < 0) { printf("Failed to open the card fb\n"); goto err_driver; } #if 0 /* ioctl wait for hotplug */ do { memset(&hw, 0, sizeof(hw)); ret = ioctl(driver->fd, DRM_IOCTL_WAIT_HOTPLUG, &hw); printf("HOTPLUG %d %d %d\n",ret,errno,hw.reply.counter); } while (ret && errno == EBUSY); #else /* signal for hotplug */ { struct sigaction sa; struct sigaction osa; sigemptyset(&sa.sa_mask); sa.sa_flags = SA_SIGINFO; sa.sa_sigaction = hotplugSIGNAL; sigaction(SIGUSR1, &sa, &osa); driverfd = driver->fd; memset(&hw, 0, sizeof(hw)); hw.request.type = _DRM_HOTPLUG_SIGNAL; hw.request.signal = SIGUSR1; ret = ioctl(driver->fd, DRM_IOCTL_WAIT_HOTPLUG, &hw); } #endif demoUpdateRes(driver); if (!driver->res) { printf("could not retrive resources\n"); goto err_res; } return driver; err_res: drmClose(driver->fd); err_driver: free(driver); return NULL; } void demoUpdateRes(struct demo_driver *driver) { if (driver->res) drmModeFreeResources(driver->res); driver->res = drmModeGetResources(driver->fd); if (!driver->res) printf("failed to get resources from kernel\n"); } int demoFindConnectedOutputs(struct demo_driver *driver, drmModeOutputPtr *out, size_t max_out) { int count = 0; int i,j; int fd = driver->fd; drmModeResPtr res = driver->res; drmModeOutputPtr output; for (i = 0; i < res->count_outputs && count < max_out; i++) { output = drmModeGetOutput(fd, res->outputs[i]); if (!output) continue; if (output->connection == DRM_MODE_DISCONNECTED) { drmModeFreeOutput(output); continue; } for (j = 0; j < output->count_props; j++) { drmModePropertyPtr prop; prop = drmModeGetProperty(fd, output->props[j]); printf("Property: %s\n",prop->name); if (prop->count_enums) printf("%s\n",prop->enums[output->prop_values[j]].name); } out[count++] = output; } return count; } void demoPanScreen(struct demo_screen *screen, uint16_t x, uint16_t y) { drmModeSetCrtc( screen->driver->fd, screen->crtc->crtc_id, screen->fb->buffer_id, x, y, screen->outputs_id, screen->num_outputs, screen->mode); } drmModeFBPtr createFB(int fd, drmModeResPtr res) { drmModeFBPtr frame; unsigned int fb = 0; int ret = 0; drmBO bo; ret = drmBOCreate(fd, SIZE_X * SIZE_Y * 4, 0, 0, DRM_BO_FLAG_READ | DRM_BO_FLAG_WRITE | DRM_BO_FLAG_MEM_TT | DRM_BO_FLAG_MEM_VRAM | DRM_BO_FLAG_NO_EVICT, DRM_BO_HINT_DONT_FENCE, &bo); if (ret) { printf("failed to create framebuffer (ret %d)\n",ret); goto err; } ret = drmModeAddFB(fd, SIZE_X, SIZE_Y, 32, 32, PITCH * 4, bo.handle, &fb); if (ret) goto err_bo; frame = drmModeGetFB(fd, fb); if (!frame) goto err_bo; return frame; err_bo: drmBOUnreference(fd, &bo); err: return 0; } void draw(unsigned int x, unsigned int y, unsigned int w, unsigned int h, unsigned int v, unsigned int *ptr) { int i, j; for (i = x; i < x + w; i++) for(j = y; j < y + h; j++) ptr[(i * PITCH) + j] = v; } void prettyColors(int fd, unsigned int handle) { drmBO bo; unsigned int *ptr; int i; drmBOReference(fd, handle, &bo); drmBOMap(fd, &bo, DRM_BO_FLAG_READ | DRM_BO_FLAG_WRITE, 0, (void**)&ptr); for (i = 0; i < (SIZE_X*SIZE_Y); i++) ptr[i] = 0xFFFFFFFF; for (i = 0; i < 8; i++) draw(i * 40, i * 40, 40, 40, 0, ptr); draw(200, 100, 40, 40, 0xff00ff, ptr); draw(100, 200, 40, 40, 0xff00ff, ptr); drmBOUnmap(fd, &bo); } void testCursor(int fd, uint32_t crtc) { drmBO bo; int ret; ret = drmBOCreate(fd, 64 * 64 * 4, 0, 0, DRM_BO_FLAG_READ | DRM_BO_FLAG_WRITE | DRM_BO_FLAG_MEM_VRAM | DRM_BO_FLAG_NO_EVICT, DRM_BO_HINT_DONT_FENCE, &bo); prettyCursor(fd, bo.handle, 0xFFFF00FF); printf("set cursor\n"); drmModeSetCursor(fd, crtc, bo.handle, 64, 64); printf("move cursor 0, 0\n"); drmModeMoveCursor(fd, crtc, 0, 0); sleep(1); prettyCursor(fd, bo.handle, 0xFFFF0000); printf("move cursor 40, 40\n"); drmModeMoveCursor(fd, crtc, 40, 40); sleep(1); printf("move cursor 100, 100\n"); drmModeMoveCursor(fd, crtc, 100, 100); sleep(1); drmModeSetCursor(fd, crtc, 0, 0, 0); } void prettyCursor(int fd, unsigned int handle, unsigned int color) { drmBO bo; unsigned int *ptr; int i; drmBOReference(fd, handle, &bo); drmBOMap(fd, &bo, DRM_BO_FLAG_READ | DRM_BO_FLAG_WRITE, 0, (void**)&ptr); for (i = 0; i < (64 * 64); i++) ptr[i] = color; drmBOUnmap(fd, &bo); drmBOUnreference(fd, &bo); } 13 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 
/* sis_mm.c -- Private header for Direct Rendering Manager -*- linux-c -*-
 * Created: Mon Jan  4 10:05:05 1999 by sclin@sis.com.tw
 *
 * Copyright 2000 Silicon Integrated Systems Corp, Inc., HsinChu, Taiwan.
 * All rights reserved.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice (including the next
 * paragraph) shall be included in all copies or substantial portions of the
 * Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * PRECISION INSIGHT AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 *
 * Authors:
 *    Sung-Ching Lin <sclin@sis.com.tw>
 *
 */

#if defined(__linux__) && defined(CONFIG_FB_SIS)
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
#include <video/sisfb.h>
#else
#include <linux/sisfb.h>
#endif
#endif
#include "drmP.h"
#include "sis_drm.h"
#include "sis_drv.h"
#include "sis_ds.h"

#define MAX_CONTEXT 100
#define VIDEO_TYPE 0
#define AGP_TYPE 1

typedef struct {
	int used;
	int context;
	set_t *sets[2];		/* 0 for video, 1 for AGP */
} sis_context_t;

static sis_context_t global_ppriv[MAX_CONTEXT];

static int add_alloc_set(int context, int type, unsigned int val)
{
	int i, retval = 0;

	for (i = 0; i < MAX_CONTEXT; i++) {
		if (global_ppriv[i].used && global_ppriv[i].context == context) {
			retval = setAdd(global_ppriv[i].sets[type], val);
			break;
		}
	}
	return retval;
}

static int del_alloc_set(int context, int type, unsigned int val)
{
	int i, retval = 0;

	for (i = 0; i < MAX_CONTEXT; i++) {
		if (global_ppriv[i].used && global_ppriv[i].context == context) {
			retval = setDel(global_ppriv[i].sets[type], val);
			break;
		}
	}
	return retval;
}

/* fb management via fb device */
#if defined(__linux__) && defined(CONFIG_FB_SIS)

static int sis_fb_init(struct drm_device *dev, void *data, struct drm_file *file_priv)
{
	return 0;
}

static int sis_fb_alloc(struct drm_device *dev, void *data, struct drm_file *file_priv)
{
	drm_sis_mem_t *fb = data;
	struct sis_memreq req;
	int retval = 0;

	req.size = fb->size;
	sis_malloc(&req);
	if (req.offset) {
		/* TODO */
		fb->offset = req.offset;
		fb->free = req.offset;
		if (!add_alloc_set(fb->context, VIDEO_TYPE, fb->free)) {
			DRM_DEBUG("adding to allocation set fails\n");
			sis_free(req.offset);
			retval = -EINVAL;
		}
	} else {
		fb->offset = 0;
		fb->size = 0;
		fb->free = 0;
	}

	DRM_DEBUG("alloc fb, size = %d, offset = %ld\n", fb->size, req.offset);

	return retval;
}

static int sis_fb_free(struct drm_device *dev, void *data, struct drm_file *file_priv)
{
	drm_sis_mem_t fb;
	int retval = 0;

	if (!fb->free)
		return -EINVAL;

	if (!del_alloc_set(fb->context, VIDEO_TYPE, fb->free))
		retval = -EINVAL;
	sis_free(fb->free);

	DRM_DEBUG("free fb, offset = 0x%lx\n", fb->free);

	return retval;
}

#else

/* Called by the X Server to initialize the FB heap.  Allocations will fail
 * unless this is called.  Offset is the beginning of the heap from the
 * framebuffer offset (MaxXFBMem in XFree86).
 *
 * Memory layout according to Thomas Winischofer:
 * |------------------|DDDDDDDDDDDDDDDDDDDDDDDDDDDDD|HHHH|CCCCCCCCCCC|
 *
 *    X driver/sisfb                                  HW-   Command-
 *  framebuffer memory           DRI heap           Cursor   queue
 */
static int sis_fb_init(struct drm_device *dev, void *data, struct drm_file *file_priv)
{
	drm_sis_private_t *dev_priv = dev->dev_private;
	drm_sis_fb_t *fb = data;

	if (dev_priv == NULL) {
		dev->dev_private = drm_calloc(1, sizeof(drm_sis_private_t),
					      DRM_MEM_DRIVER);
		dev_priv = dev->dev_private;
		if (dev_priv == NULL)
			return ENOMEM;
	}

	if (dev_priv->FBHeap != NULL)
		return -EINVAL;

	dev_priv->FBHeap = mmInit(fb->offset, fb->size);

	DRM_DEBUG("offset = %u, size = %u", fb->offset, fb->size);

	return 0;
}

static int sis_fb_alloc(struct drm_device *dev, void *data, struct drm_file *file_priv)
{
	drm_sis_private_t *dev_priv = dev->dev_private;
	drm_sis_mem_t *fb = data;
	PMemBlock block;
	int retval = 0;

	if (dev_priv == NULL || dev_priv->FBHeap == NULL)
		return -EINVAL;

	block = mmAllocMem(dev_priv->FBHeap, fb->size, 0, 0);
	if (block) {
		/* TODO */
		fb->offset = block->ofs;
		fb->free = (unsigned long)block;
		if (!add_alloc_set(fb->context, VIDEO_TYPE, fb->free)) {
			DRM_DEBUG("adding to allocation set fails\n");
			mmFreeMem((PMemBlock) fb->free);
			retval = -EINVAL;
		}
	} else {
		fb->offset = 0;
		fb->size = 0;
		fb->free = 0;
	}

	DRM_DEBUG("alloc fb, size = %d, offset = %d\n", fb->size, fb->offset);

	return retval;
}

static int sis_fb_free(struct drm_device *dev, void *data, struct drm_file *file_priv)
{
	drm_sis_private_t *dev_priv = dev->dev_private;
	drm_sis_mem_t *fb = data;

	if (dev_priv == NULL || dev_priv->FBHeap == NULL)
		return -EINVAL;

	if (!mmBlockInHeap(dev_priv->FBHeap, (PMemBlock) fb->free))
		return -EINVAL;

	if (!del_alloc_set(fb->context, VIDEO_TYPE, fb->free))
		return -EINVAL;
	mmFreeMem((PMemBlock) fb->free);

	DRM_DEBUG("free fb, free = 0x%lx\n", fb->free);

	return 0;
}

#endif

/* agp memory management */

static int sis_ioctl_agp_init(struct drm_device *dev, void *data, struct drm_file *file_priv)
{
	drm_sis_private_t *dev_priv = dev->dev_private;
	drm_sis_agp_t *agp = data;

	if (dev_priv == NULL) {
		dev->dev_private = drm_calloc(1, sizeof(drm_sis_private_t),
					      DRM_MEM_DRIVER);
		dev_priv = dev->dev_private;
		if (dev_priv == NULL)
			return ENOMEM;
	}

	if (dev_priv->AGPHeap != NULL)
		return -EINVAL;

	dev_priv->AGPHeap = mmInit(agp->offset, agp->size);

	DRM_DEBUG("offset = %u, size = %u", agp->offset, agp->size);

	return 0;
}

static int sis_ioctl_agp_alloc(struct drm_device *dev, void *data, struct drm_file *file_priv)
{
	drm_sis_private_t *dev_priv = dev->dev_private;
	drm_sis_mem_t *agp = data;
	PMemBlock block;
	int retval = 0;

	if (dev_priv == NULL || dev_priv->AGPHeap == NULL)
		return -EINVAL;

	block = mmAllocMem(dev_priv->AGPHeap, agp->size, 0, 0);
	if (block) {
		/* TODO */
		agp->offset = block->ofs;
		agp->free = (unsigned long)block;
		if (!add_alloc_set(agp->context, AGP_TYPE, agp->free)) {
			DRM_DEBUG("adding to allocation set fails\n");
			mmFreeMem((PMemBlock) agp->free);
			retval = -1;
		}
	} else {
		agp->offset = 0;
		agp->size = 0;
		agp->free = 0;
	}

	DRM_DEBUG("alloc agp, size = %d, offset = %d\n", agp->size,
	    agp->offset);

	return retval;
}

static int sis_ioctl_agp_free(struct drm_device *dev, void *data, struct drm_file *file_priv)
{
	drm_sis_private_t *dev_priv = dev->dev_private;
	drm_sis_mem_t *agp = data;

	if (dev_priv == NULL || dev_priv->AGPHeap == NULL)
		return -EINVAL;

	if (!mmBlockInHeap(dev_priv->AGPHeap, (PMemBlock) agp->free))
		return -EINVAL;

	mmFreeMem((PMemBlock) agp->free);
	if (!del_alloc_set(agp->context, AGP_TYPE, agp->free))
		return -EINVAL;

	DRM_DEBUG("free agp, free = 0x%lx\n", agp->free);

	return 0;
}

int sis_init_context(struct drm_device *dev, int context)
{
	int i;

	for (i = 0; i < MAX_CONTEXT; i++) {
		if (global_ppriv[i].used &&
		    (global_ppriv[i].context == context))
			break;
	}

	if (i >= MAX_CONTEXT) {
		for (i = 0; i < MAX_CONTEXT; i++) {
			if (!global_ppriv[i].used) {
				global_ppriv[i].context = context;
				global_ppriv[i].used = 1;
				global_ppriv[i].sets[0] = setInit();
				global_ppriv[i].sets[1] = setInit();
				DRM_DEBUG("init allocation set, socket=%d, "
					  "context = %d\n", i, context);
				break;
			}
		}
		if ((i >= MAX_CONTEXT) || (global_ppriv[i].sets[0] == NULL) ||
		    (global_ppriv[i].sets[1] == NULL)) {
			return 0;
		}
	}

	return 1;
}

int sis_final_context(struct drm_device *dev, int context)
{
	int i;

	for (i = 0; i < MAX_CONTEXT; i++) {
		if (global_ppriv[i].used &&
		    (global_ppriv[i].context == context))
			break;
	}

	if (i < MAX_CONTEXT) {
		set_t *set;
		ITEM_TYPE item;
		int retval;

		DRM_DEBUG("find socket %d, context = %d\n", i, context);

		/* Video Memory */
		set = global_ppriv[i].sets[0];
		retval = setFirst(set, &item);
		while (retval) {
			DRM_DEBUG("free video memory 0x%lx\n", item);
#if defined(__linux__) && defined(CONFIG_FB_SIS)
			sis_free(item);
#else
			mmFreeMem((PMemBlock) item);
#endif
			retval = setNext(set, &item);
		}
		setDestroy(set);

		/* AGP Memory */
		set = global_ppriv[i].sets[1];
		retval = setFirst(set, &item);
		while (retval) {
			DRM_DEBUG("free agp memory 0x%lx\n", item);
			mmFreeMem((PMemBlock) item);
			retval = setNext(set, &item);
		}
		setDestroy(set);

		global_ppriv[i].used = 0;
	}

	return 1;
}

drm_ioctl_desc_t sis_ioctls[] = {
	DRM_IOCTL_DEF(DRM_SIS_FB_ALLOC, sis_fb_alloc, DRM_AUTH),
	DRM_IOCTL_DEF(DRM_SIS_FB_FREE, sis_fb_free, DRM_AUTH),
	DRM_IOCTL_DEF(DRM_SIS_AGP_INIT, sis_ioctl_agp_init, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY),
	DRM_IOCTL_DEF(DRM_SIS_AGP_ALLOC, sis_ioctl_agp_alloc, DRM_AUTH),
	DRM_IOCTL_DEF(DRM_SIS_AGP_FREE, sis_ioctl_agp_free, DRM_AUTH),
	DRM_IOCTL_DEF(DRM_SIS_FB_INIT, sis_fb_init, DRM_AUTH|DRM_MASTER|DRM_ROOT_ONLY)
};

int sis_max_ioctl = DRM_ARRAY_SIZE(sis_ioctls);
generated by cgit v1.2.3 (git 2.25.1) at 2025-11-19 09:54:29 +0000