/**

  * $Id: eventq.c,v 1.1 2007-01-06 04:06:36 nkeynes Exp $

  *

  * Simple implementation of one-shot timers. Effectively this allows IO

  * devices to wait until a particular time before completing. We expect 

  * there to be at least half a dozen or so continually scheduled events

  * (TMU and PVR2), peaking around 20+.

  *

  * Copyright (c) 2005 Nathan Keynes.

  *

  * This program is free software; you can redistribute it and/or modify

  * it under the terms of the GNU General Public License as published by

  * the Free Software Foundation; either version 2 of the License, or

  * (at your option) any later version.

  *

  * This program is distributed in the hope that it will be useful,

  * but WITHOUT ANY WARRANTY; without even the implied warranty of

  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

  * GNU General Public License for more details.

  */

 #include <assert.h>

 #include "dreamcast.h"

 #include "eventq.h"

 #include "sh4core.h"

 #define LONG_SCAN_PERIOD 1000000000 /* 1 second */

 typedef struct event {

     uint32_t id;

     uint32_t seconds;

     uint32_t nanosecs;

     event_func_t func;

     struct event *next;

 } *event_t;

 static struct event events[MAX_EVENT_ID];

 /**

  * Countdown to the next scan of the long-duration list (greater than 1 second).

  */

 static int long_scan_time_remaining;

 static event_t event_head;

 static event_t long_event_head;

 void event_reset();

 void event_init();

 uint32_t event_run_slice( uint32_t nanosecs );

 void event_save_state( FILE *f );

 int event_load_state( FILE * f );

 struct dreamcast_module eventq_module = { "EVENTQ", event_init, event_reset, NULL, event_run_slice,

 					NULL, event_save_state, event_load_state };

 static void event_update_pending( ) 

 {

     if( event_head == NULL ) {

 	if( !(sh4r.event_types & PENDING_IRQ) ) {

 	    sh4r.event_pending = NOT_SCHEDULED;

 	}

 	sh4r.event_types &= (~PENDING_EVENT);

     } else {

 	if( !(sh4r.event_types & PENDING_IRQ) ) {

 	    sh4r.event_pending = event_head->nanosecs;

 	}

 	sh4r.event_types |= PENDING_EVENT;

     }

 }

 uint32_t event_get_next_time( ) 

 {

     if( event_head == NULL ) {

 	return NOT_SCHEDULED;

     } else {

 	return event_head->nanosecs;

     }

 }

 /**

  * Add the event to the short queue.

  */

 static void event_enqueue( event_t event ) 

 {

     if( event_head == NULL || event->nanosecs < event_head->nanosecs ) {

 	event->next = event_head;

 	event_head = event;

 	event_update_pending();

     } else {

 	event_t cur = event_head;

 	event_t next = cur->next;

 	while( next != NULL && event->nanosecs >= next->nanosecs ) {

 	    cur = next;

 	    next = cur->next;

 	}

 	event->next = next;

 	cur->next = event;

     }

 }

 static void event_dequeue( event_t event )

 {

     if( event_head == NULL ) {

 	ERROR( "Empty event queue but should contain event %d", event->id );

     } else if( event_head == event ) {

 	/* removing queue head */

 	event_head = event_head->next;

 	event_update_pending();

     } else {

 	event_t cur = event_head;

 	event_t next = cur->next;

 	while( next != NULL ) {

 	    if( next == event ) {

 		cur->next = next->next;

 		break;

 	    }

 	    cur = next;

 	    next = cur->next;

 	}

     }

 }

 static void event_dequeue_long( event_t event ) 

 {

     if( long_event_head == NULL ) {

 	ERROR( "Empty long event queue but should contain event %d", event->id );

     } else if( long_event_head == event ) {

 	/* removing queue head */

 	long_event_head = long_event_head->next;

     } else {

 	event_t cur = long_event_head;

 	event_t next = cur->next;

 	while( next != NULL ) {

 	    if( next == event ) {

 		cur->next = next->next;

 		break;

 	    }

 	    cur = next;

 	    next = cur->next;

 	}

     }

 }

 void register_event_callback( int eventid, event_func_t func )

 {

     events[eventid].func = func;

 }

 void event_schedule( int eventid, uint32_t nanosecs )

 {

     int i;

     nanosecs += sh4r.slice_cycle;

     event_t event = &events[eventid];

     if( event->nanosecs != NOT_SCHEDULED ) {

 	/* Event is already scheduled. Remove it from the list first */

 	event_cancel(eventid);

     }

     event->id = eventid;

     event->seconds = 0;

     event->nanosecs = nanosecs;

     event_enqueue( event );

 }

 void event_schedule_long( int eventid, uint32_t seconds, uint32_t nanosecs ) {

     if( seconds == 0 ) {

 	event_schedule( eventid, nanosecs );

     } else {

 	event_t event = &events[eventid];

 	if( event->nanosecs != NOT_SCHEDULED ) {

 	    /* Event is already scheduled. Remove it from the list first */

 	    event_cancel(eventid);

 	}

 	event->id = eventid;

 	event->seconds = seconds;

 	event->nanosecs = nanosecs;

 	event->next = long_event_head;

 	long_event_head = event;

     }

 }

 void event_cancel( int eventid )

 {

     event_t event = &events[eventid];

     if( event->nanosecs == NOT_SCHEDULED ) {

 	return; /* not scheduled */

     } else {

 	event->nanosecs = NOT_SCHEDULED;

 	if( event->seconds != 0 ) { /* long term event */

 	    event_dequeue_long( event );

 	} else {

 	    event_dequeue( event );

 	}

     }

 }

 void event_execute()

 {

     /* Loop in case we missed some or got a couple scheduled for the same time */

     while( event_head != NULL && event_head->nanosecs <= sh4r.slice_cycle ) {

 	event_t event = event_head;

 	event_head = event->next;

 	event->nanosecs = NOT_SCHEDULED;

 	// Note: Make sure the internal state is consistent before calling the

 	// user function, as it will (quite likely) enqueue another event.

 	event->func( event->id );

     }

     event_update_pending();

 }

 void event_asic_callback( int eventid )

 {

     asic_event( eventid );

 }

 void event_init()

 {

     int i;

     for( i=0; i<MAX_EVENT_ID; i++ ) {

 	events[i].id = i;

 	events[i].nanosecs = NOT_SCHEDULED;

 	if( i < 96 ) {

 	    events[i].func = event_asic_callback;

 	} else {

 	    events[i].func = NULL;

 	}

 	events[i].next = NULL;

     }

     event_head = NULL;

     long_event_head = NULL;

     long_scan_time_remaining = LONG_SCAN_PERIOD;

 }

 void event_reset()

 {

     int i;

     event_head = NULL;

     long_event_head = NULL;

     long_scan_time_remaining = LONG_SCAN_PERIOD;

     for( i=0; i<MAX_EVENT_ID; i++ ) {

 	events[i].nanosecs = NOT_SCHEDULED;

     }

 }

 void event_save_state( FILE *f )

 {

     int id, i;

     id = event_head == NULL ? -1 : event_head->id;

     fwrite( &id, sizeof(id), 1, f );

     id = long_event_head == NULL ? -1 : long_event_head->id;

     fwrite( &id, sizeof(id), 1, f );

     fwrite( &long_scan_time_remaining, sizeof(long_scan_time_remaining), 1, f );

     for( i=0; i<MAX_EVENT_ID; i++ ) {

 	fwrite( &events[i].id, sizeof(uint32_t), 3, f ); /* First 3 words from structure */

 	id = events[i].next == NULL ? -1 : events[i].next->id;

 	fwrite( &id, sizeof(id), 1, f );

     }

 }

 int event_load_state( FILE *f )

 {

     int id, i;

     fread( &id, sizeof(id), 1, f );

     event_head = id == -1 ? NULL : &events[id];

     fread( &id, sizeof(id), 1, f );

     long_event_head = id == -1 ? NULL : &events[id];

     fread( &long_scan_time_remaining, sizeof(long_scan_time_remaining), 1, f );

     for( i=0; i<MAX_EVENT_ID; i++ ) {

 	fread( &events[i].id, sizeof(uint32_t), 3, f );

 	fread( &id, sizeof(id), 1, f );

 	events[i].next = id == -1 ? NULL : &events[id];

     }

     return 0;

 }

 /**

  * Scan all entries in the long queue, decrementing each by 1 second. Entries

  * that are now < 1 second are moved to the short queue.

  */

 static void event_scan_long()

 {

     while( long_event_head != NULL && --long_event_head->seconds == 0 ) {

 	event_t event = long_event_head;

 	long_event_head = event->next;

 	event_enqueue(event);

     }

     if( long_event_head != NULL ) {

 	event_t last = long_event_head;

 	event_t cur = last->next;

 	while( cur != NULL ) {

 	    if( --cur->seconds == 0 ) {

 		last->next = cur->next;

 		event_enqueue(cur);

 	    } else {

 		last = cur;

 	    }

 	    cur = last->next;

 	}

     }

 }

 /**

  * Decrement the event time on all pending events by the supplied nanoseconds.

  * It may or may not be faster to wrap around instead, but this has the benefit

  * of simplicity.

  */

 uint32_t event_run_slice( uint32_t nanosecs )

 {

     event_t event = event_head;

     while( event != NULL ) {

 	if( event->nanosecs <= nanosecs ) {

 	    event->nanosecs = 0;

 	} else {

 	    event->nanosecs -= nanosecs;

 	}

 	event = event->next;

     }

     long_scan_time_remaining -= nanosecs;

     if( long_scan_time_remaining <= 0 ) {

 	long_scan_time_remaining += LONG_SCAN_PERIOD;

 	event_scan_long();

     }

     event_update_pending();

     return nanosecs;

 }