#include <string.h>

#include <malloc.h>

#include <syscall.h>
#include <debug.h>
#include <user_region.h>

#include <gip.h>

typedef struct {
	fb_info_t mode;
	fd_t fd;
} giosrv_t;

void reset(gip_handler_t *s, gip_msg_header *p);
void enable_features(gip_handler_t *s, gip_msg_header *p);
void disable_features(gip_handler_t *s, gip_msg_header *p);
void query_mode(gip_handler_t *s, gip_msg_header *p);
void set_mode(gip_handler_t *s, gip_msg_header *p);
void unknown_msg(gip_handler_t *s, gip_msg_header *p);
void fd_error(gip_handler_t *s);

gip_handler_callbacks_t giosrv_cb = {
	.reset = reset,
	.initiate = 0,
	.ok = 0,
	.failure = 0,
	.enable_features = enable_features,
	.disable_features = disable_features,
	.query_mode = query_mode,
	.set_mode = set_mode,
	.buffer_info = 0,
	.mode_info = 0,
	.buffer_damage = 0,
	.unknown_msg = unknown_msg,
	.fd_error = fd_error,
};

int main(int argc, char **argv) {
	dbg_print("[giosrv] Starting up.\n");

	giosrv_t srv;

	srv.fd = open("io:/display/vesa", FM_IOCTL | FM_READ | FM_WRITE | FM_MMAP);
	if (srv.fd == 0) PANIC("Could not open fbdev");


	int r = ioctl(srv.fd, IOCTL_FB_GET_INFO, &srv.mode);
	ASSERT(r == 1);
	dbg_printf("[giosrv] Running on FB %dx%d\n", srv.mode.width, srv.mode.height);

	gip_handler_t *h = new_gip_handler(&giosrv_cb, &srv);
	ASSERT(h != 0);

	h->mainloop_item.fd = 1;
	mainloop_add_fd(&h->mainloop_item);
	mainloop_run();

	dbg_printf("[giosrv] Main loop exited, terminating.\n");

	return 0;
}

void send_buffer_info(gip_handler_t *h, giosrv_t *s) {
	gip_msg_header msg = {
		.code = GIPN_BUFFER_INFO,
		.arg = 0,
	};
	gip_buffer_info_msg msg_data;

	msg_data.geom = s->mode;
	if (!gen_token(s->fd, &msg_data.tok)) {
		dbg_printf("[giosrv] Could not generate token for buffer_info_msg.\n");
	} else {
		dbg_printf("[giosrv] Generated token: %x %x\n",
			((uint32_t*)&msg_data.tok)[0], ((uint32_t*)&msg_data.tok)[1]);
		gip_notify(h, &msg, &msg_data);
	}
}

void reset(gip_handler_t *h, gip_msg_header *p) {
	giosrv_t *s = (giosrv_t*)h->data;

	//  ---- Send initiate message
	gip_msg_header msg = {
		.code = GIPR_INITIATE,
		.arg = GIPF_MODESET
	};
	gip_reply(h, p, &msg, 0);

	//  ---- Send buffer information
	send_buffer_info(h, s);
}

void enable_features(gip_handler_t *h, gip_msg_header *p) {
	gip_reply_fail(h, p);
}

void disable_features(gip_handler_t *h, gip_msg_header *p) {
	gip_reply_fail(h, p);
}

void query_mode(gip_handler_t *h, gip_msg_header *p) {
	// TODO
}

void set_mode(gip_handler_t *h, gip_msg_header *p) {
	// TODO
}

void unknown_msg(gip_handler_t *h, gip_msg_header *p) {
	// TODO
}

void fd_error(gip_handler_t *h) {
	// TODO
}

/* vim: set ts=4 sw=4 tw=0 noet :*/