2002-12-07 22:51:42 +03:00
|
|
|
////////////////////////////////////////////////////////////////////////
|
2003-04-04 01:59:20 +04:00
|
|
|
// $Id: pit_wrap.cc,v 1.49 2003-04-03 21:59:20 yakovlev Exp $
|
2001-10-03 17:10:38 +04:00
|
|
|
/////////////////////////////////////////////////////////////////////////
|
|
|
|
//
|
2002-01-29 20:20:12 +03:00
|
|
|
// Copyright (C) 2002 MandrakeSoft S.A.
|
2001-06-11 07:09:40 +04:00
|
|
|
//
|
|
|
|
// MandrakeSoft S.A.
|
|
|
|
// 43, rue d'Aboukir
|
|
|
|
// 75002 Paris - France
|
|
|
|
// http://www.linux-mandrake.com/
|
|
|
|
// http://www.mandrakesoft.com/
|
|
|
|
//
|
|
|
|
// This library is free software; you can redistribute it and/or
|
|
|
|
// modify it under the terms of the GNU Lesser General Public
|
|
|
|
// License as published by the Free Software Foundation; either
|
|
|
|
// version 2 of the License, or (at your option) any later version.
|
|
|
|
//
|
|
|
|
// This library 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
|
|
|
|
// Lesser General Public License for more details.
|
|
|
|
//
|
|
|
|
// You should have received a copy of the GNU Lesser General Public
|
|
|
|
// License along with this library; if not, write to the Free Software
|
|
|
|
// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
|
|
|
|
|
|
|
2002-09-21 03:10:55 +04:00
|
|
|
//Realtime Algorithm (with gettimeofday)
|
|
|
|
// HAVE:
|
|
|
|
// Real number of usec.
|
|
|
|
// Emulated number of usec.
|
|
|
|
// WANT:
|
|
|
|
// Number of ticks to use.
|
|
|
|
// Number of emulated usec to wait until next try.
|
|
|
|
//
|
|
|
|
// ticks=number of ticks needed to match total real usec.
|
|
|
|
// if(desired ticks > max ticks for elapsed real time)
|
|
|
|
// ticks = max ticks for elapsed real time.
|
|
|
|
// if(desired ticks > max ticks for elapsed emulated usec)
|
|
|
|
// ticks = max ticks for emulated usec.
|
|
|
|
// next wait ticks = number of ticks until next event.
|
|
|
|
// next wait real usec = (current ticks + next wait ticks) * usec per ticks
|
|
|
|
// next wait emulated usec = next wait real usec * emulated usec / real usec
|
|
|
|
// if(next wait emulated usec < minimum emulated usec for next wait ticks)
|
|
|
|
// next wait emulated usec = minimum emulated usec for next wait ticks.
|
|
|
|
// if(next wait emulated usec > max emulated usec wait)
|
|
|
|
// next wait emulated usec = max emulated usec wait.
|
|
|
|
//
|
|
|
|
// How to calculate elapsed real time:
|
|
|
|
// store an unused time value whenever no ticks are used in a given time.
|
|
|
|
// add this to the current elapsed time.
|
|
|
|
// How to calculate elapsed emulated time:
|
|
|
|
// same as above.
|
|
|
|
// Above can be done by not updating last_usec and last_sec.
|
|
|
|
//
|
|
|
|
// How to calculate emulated usec/real usec:
|
|
|
|
// Each time there are actual ticks:
|
|
|
|
// Alpha_product(old emulated usec, emulated usec);
|
|
|
|
// Alpha_product(old real usec, real usec);
|
|
|
|
// Divide resulting values.
|
|
|
|
|
2001-06-11 07:09:40 +04:00
|
|
|
|
|
|
|
#include "bochs.h"
|
2001-07-02 00:49:46 +04:00
|
|
|
|
2001-08-16 00:23:58 +04:00
|
|
|
#if BX_USE_NEW_PIT
|
2001-07-02 00:49:46 +04:00
|
|
|
|
2001-06-11 07:09:40 +04:00
|
|
|
#include "pit_wrap.h"
|
2002-10-31 02:54:29 +03:00
|
|
|
|
|
|
|
|
|
|
|
//Important constant #defines:
|
|
|
|
#define USEC_PER_SECOND (1000000)
|
|
|
|
//1.193181MHz Clock
|
|
|
|
#define TICKS_PER_SECOND (1193181)
|
|
|
|
|
|
|
|
|
2002-12-05 20:43:00 +03:00
|
|
|
// define a macro to convert floating point numbers into 64-bit integers.
|
|
|
|
// In MSVC++ you can convert a 64-bit float into a 64-bit signed integer,
|
|
|
|
// but it will not convert a 64-bit float into a 64-bit unsigned integer.
|
|
|
|
// This macro works around that.
|
|
|
|
#define F2I(x) ((Bit64u)(Bit64s) (x))
|
|
|
|
#define I2F(x) ((double)(Bit64s) (x))
|
|
|
|
|
2002-10-31 02:54:29 +03:00
|
|
|
//CONFIGURATION #defines:
|
|
|
|
|
|
|
|
|
|
|
|
//MAINLINE Configuration (For realtime PIT):
|
|
|
|
|
|
|
|
//How much faster than real time we can go:
|
|
|
|
#define MAX_MULT (1.25)
|
|
|
|
|
|
|
|
//Minimum number of emulated useconds per second.
|
|
|
|
// Now calculated using BX_MIN_IPS, the minimum number of
|
|
|
|
// instructions per second.
|
|
|
|
#if 1
|
|
|
|
# define MIN_USEC_PER_SECOND (((((Bit64u)USEC_PER_SECOND)*((Bit64u)BX_MIN_IPS))/((Bit64u)(bx_options.Oips->get())))+(Bit64u)1)
|
|
|
|
#else
|
|
|
|
# define MIN_USEC_PER_SECOND (150000)
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if !BX_HAVE_REALTIME_USEC
|
|
|
|
//These are only used if we don't have a way of getting accurate time.
|
|
|
|
//How much slower than real time we can go:
|
|
|
|
# define MIN_MULT (0.9)
|
|
|
|
|
|
|
|
//How much farther ahead we can get before we just stop
|
|
|
|
// and wait for real time to catch up:
|
|
|
|
# define AHEAD_CEILING ((Bit64u)(TICKS_PER_SECOND*2))
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
//DEBUG configuration:
|
|
|
|
|
|
|
|
//Debug with printf options.
|
2002-12-07 22:51:42 +03:00
|
|
|
#define DEBUG_REALTIME_WITH_PRINTF 0
|
2002-10-31 02:54:29 +03:00
|
|
|
|
|
|
|
//Use to test execution at multiples of real time.
|
|
|
|
#define TIME_DIVIDER (1)
|
|
|
|
#define TIME_MULTIPLIER (1)
|
|
|
|
#define TIME_HEADSTART (0)
|
|
|
|
|
|
|
|
|
2002-12-07 22:51:42 +03:00
|
|
|
#define GET_PIT_REALTIME64_USEC() (((bx_get_realtime64_usec()*(Bit64u)TIME_MULTIPLIER/(Bit64u)TIME_DIVIDER)))
|
2002-10-31 02:54:29 +03:00
|
|
|
//Set up Logging.
|
2001-07-02 00:49:46 +04:00
|
|
|
#define LOG_THIS bx_pit.
|
2001-06-11 07:09:40 +04:00
|
|
|
|
2002-10-31 02:54:29 +03:00
|
|
|
//A single instance.
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c bx_pit;
|
2001-06-11 07:09:40 +04:00
|
|
|
#if BX_USE_PIT_SMF
|
2001-07-02 00:49:46 +04:00
|
|
|
#define this (&bx_pit)
|
2001-06-11 07:09:40 +04:00
|
|
|
#endif
|
|
|
|
|
2002-10-31 02:54:29 +03:00
|
|
|
//Workaround for environments where OUT is defined.
|
2001-06-11 07:09:40 +04:00
|
|
|
#ifdef OUT
|
|
|
|
# undef OUT
|
|
|
|
#endif
|
|
|
|
|
2002-09-21 03:10:55 +04:00
|
|
|
|
2002-10-31 02:54:29 +03:00
|
|
|
//Generic MAX and MIN Functions
|
|
|
|
#define BX_MAX(a,b) ( ((a)>(b))?(a):(b) )
|
|
|
|
#define BX_MIN(a,b) ( ((a)>(b))?(b):(a) )
|
2002-02-09 01:27:51 +03:00
|
|
|
|
2002-10-30 21:30:29 +03:00
|
|
|
|
2002-02-08 00:22:55 +03:00
|
|
|
//USEC_ALPHA is multiplier for the past.
|
|
|
|
//USEC_ALPHA_B is 1-USEC_ALPHA, or multiplier for the present.
|
2002-02-09 01:27:51 +03:00
|
|
|
#define USEC_ALPHA ((double)(.8))
|
|
|
|
#define USEC_ALPHA_B ((double)(((double)1)-USEC_ALPHA))
|
2002-05-21 01:53:26 +04:00
|
|
|
#define USEC_ALPHA2 ((double)(.5))
|
|
|
|
#define USEC_ALPHA2_B ((double)(((double)1)-USEC_ALPHA2))
|
2002-12-05 20:43:00 +03:00
|
|
|
#define ALPHA_LOWER(old,new) ((Bit64u)((old<new)?((USEC_ALPHA*(I2F(old)))+(USEC_ALPHA_B*(I2F(new)))):((USEC_ALPHA2*(I2F(old)))+(USEC_ALPHA2_B*(I2F(new))))))
|
2002-02-08 00:22:55 +03:00
|
|
|
|
2002-10-31 02:54:29 +03:00
|
|
|
|
|
|
|
//PIT tick to usec conversion functions:
|
|
|
|
//Direct conversions:
|
2002-09-21 03:10:55 +04:00
|
|
|
#define REAL_TICKS_TO_USEC(a) ( ((a)*USEC_PER_SECOND)/TICKS_PER_SECOND )
|
|
|
|
#define REAL_USEC_TO_TICKS(a) ( ((a)*TICKS_PER_SECOND)/USEC_PER_SECOND )
|
2002-10-31 02:54:29 +03:00
|
|
|
|
|
|
|
//Conversion between emulated useconds and optionally realtime ticks.
|
|
|
|
#define TICKS_TO_USEC(a) ((BX_PIT_THIS s.use_realtime)?( ((a)*BX_PIT_THIS s.usec_per_second)/BX_PIT_THIS s.ticks_per_second ):( REAL_TICKS_TO_USEC(a) ))
|
|
|
|
#define USEC_TO_TICKS(a) ((BX_PIT_THIS s.use_realtime)?( ((a)*BX_PIT_THIS s.ticks_per_second)/BX_PIT_THIS s.usec_per_second ):( REAL_USEC_TO_TICKS(a) ))
|
|
|
|
|
2001-10-11 17:01:27 +04:00
|
|
|
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c::bx_pit_c( void )
|
2001-06-11 07:09:40 +04:00
|
|
|
{
|
2001-06-27 23:16:01 +04:00
|
|
|
put("PIT");
|
2001-06-11 07:09:40 +04:00
|
|
|
settype(PITLOG);
|
|
|
|
s.speaker_data_on=0;
|
|
|
|
|
|
|
|
/* 8254 PIT (Programmable Interval Timer) */
|
|
|
|
|
2001-07-02 00:49:46 +04:00
|
|
|
BX_PIT_THIS s.timer_handle[1] = BX_NULL_TIMER_HANDLE;
|
|
|
|
BX_PIT_THIS s.timer_handle[2] = BX_NULL_TIMER_HANDLE;
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_PIT_THIS s.timer_handle[0] = BX_NULL_TIMER_HANDLE;
|
2001-06-11 07:09:40 +04:00
|
|
|
}
|
|
|
|
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c::~bx_pit_c( void )
|
2001-06-11 07:09:40 +04:00
|
|
|
{
|
|
|
|
}
|
|
|
|
|
|
|
|
int
|
2002-10-25 01:07:56 +04:00
|
|
|
bx_pit_c::init( void )
|
2001-06-11 07:09:40 +04:00
|
|
|
{
|
2002-10-25 01:07:56 +04:00
|
|
|
bx_devices.register_irq(0, "8254 PIT");
|
|
|
|
bx_devices.register_io_read_handler(this, read_handler, 0x0040, "8254 PIT");
|
|
|
|
bx_devices.register_io_read_handler(this, read_handler, 0x0041, "8254 PIT");
|
|
|
|
bx_devices.register_io_read_handler(this, read_handler, 0x0042, "8254 PIT");
|
|
|
|
bx_devices.register_io_read_handler(this, read_handler, 0x0043, "8254 PIT");
|
|
|
|
bx_devices.register_io_read_handler(this, read_handler, 0x0061, "8254 PIT");
|
|
|
|
|
|
|
|
bx_devices.register_io_write_handler(this, write_handler, 0x0040, "8254 PIT");
|
|
|
|
bx_devices.register_io_write_handler(this, write_handler, 0x0041, "8254 PIT");
|
|
|
|
bx_devices.register_io_write_handler(this, write_handler, 0x0042, "8254 PIT");
|
|
|
|
bx_devices.register_io_write_handler(this, write_handler, 0x0043, "8254 PIT");
|
|
|
|
bx_devices.register_io_write_handler(this, write_handler, 0x0061, "8254 PIT");
|
2001-06-11 07:09:40 +04:00
|
|
|
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_DEBUG(("pit: starting init"));
|
|
|
|
|
2001-07-02 00:49:46 +04:00
|
|
|
BX_PIT_THIS s.speaker_data_on = 0;
|
|
|
|
BX_PIT_THIS s.refresh_clock_div2 = 0;
|
2001-06-11 07:09:40 +04:00
|
|
|
|
2003-02-18 19:57:44 +03:00
|
|
|
BX_PIT_THIS s.use_realtime = 0 ; // was: bx_options.Orealtime_pit->get ();
|
2002-10-28 08:55:47 +03:00
|
|
|
|
2001-07-02 00:49:46 +04:00
|
|
|
BX_PIT_THIS s.timer.init();
|
2001-06-11 07:09:40 +04:00
|
|
|
|
2003-04-04 01:59:20 +04:00
|
|
|
Bit64u my_time_usec = bx_virt_timer.time_usec();
|
|
|
|
|
2002-10-06 23:04:47 +04:00
|
|
|
if (BX_PIT_THIS s.timer_handle[0] == BX_NULL_TIMER_HANDLE) {
|
2003-02-18 19:54:48 +03:00
|
|
|
BX_PIT_THIS s.timer_handle[0] = bx_virt_timer.register_timer(this, timer_handler, (unsigned) 100 , 1, 1, "pit_wrap");
|
2002-10-06 23:04:47 +04:00
|
|
|
}
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_DEBUG(("pit: RESETting timer."));
|
2003-02-18 19:54:48 +03:00
|
|
|
bx_virt_timer.deactivate_timer(BX_PIT_THIS s.timer_handle[0]);
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_DEBUG(("deactivated timer."));
|
|
|
|
if(BX_PIT_THIS s.timer.get_next_event_time()) {
|
2003-02-18 19:54:48 +03:00
|
|
|
bx_virt_timer.activate_timer(BX_PIT_THIS s.timer_handle[0],
|
2002-09-23 07:49:39 +04:00
|
|
|
BX_MAX(1,TICKS_TO_USEC(BX_PIT_THIS s.timer.get_next_event_time())),
|
2001-08-18 07:28:23 +04:00
|
|
|
0);
|
|
|
|
BX_DEBUG(("activated timer."));
|
|
|
|
}
|
|
|
|
BX_PIT_THIS s.last_next_event_time = BX_PIT_THIS s.timer.get_next_event_time();
|
2003-04-04 01:59:20 +04:00
|
|
|
BX_PIT_THIS s.last_usec=my_time_usec;
|
2001-08-18 07:28:23 +04:00
|
|
|
|
2002-01-31 20:18:38 +03:00
|
|
|
BX_PIT_THIS s.total_ticks=0;
|
|
|
|
|
2002-10-28 08:55:47 +03:00
|
|
|
if (BX_PIT_THIS s.use_realtime) {
|
2002-09-21 08:02:51 +04:00
|
|
|
BX_PIT_THIS s.usec_per_second=USEC_PER_SECOND;
|
|
|
|
BX_PIT_THIS s.ticks_per_second=TICKS_PER_SECOND;
|
|
|
|
BX_PIT_THIS s.total_sec=0;
|
|
|
|
BX_PIT_THIS s.stored_delta=0;
|
2002-09-23 06:20:52 +04:00
|
|
|
#if BX_HAVE_REALTIME_USEC
|
2002-12-07 22:51:42 +03:00
|
|
|
BX_PIT_THIS s.last_time=GET_PIT_REALTIME64_USEC()+(Bit64u)TIME_HEADSTART*(Bit64u)USEC_PER_SECOND;
|
2002-12-07 23:01:10 +03:00
|
|
|
BX_PIT_THIS s.em_last_realtime=0;
|
|
|
|
BX_PIT_THIS s.last_realtime_delta=0;
|
|
|
|
BX_PIT_THIS s.last_realtime_ticks=0;
|
2002-09-20 08:42:25 +04:00
|
|
|
#else
|
2002-09-21 08:02:51 +04:00
|
|
|
BX_PIT_THIS s.last_time=((time(NULL)*TIME_MULTIPLIER/TIME_DIVIDER)+TIME_HEADSTART)*USEC_PER_SECOND;
|
|
|
|
BX_PIT_THIS s.max_ticks = AHEAD_CEILING;
|
2002-10-31 02:54:29 +03:00
|
|
|
#endif
|
2002-09-21 08:02:51 +04:00
|
|
|
} else {
|
|
|
|
BX_PIT_THIS s.total_usec=0;
|
|
|
|
}
|
2002-02-08 00:22:55 +03:00
|
|
|
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_DEBUG(("pit: finished init"));
|
|
|
|
|
2003-01-05 04:37:21 +03:00
|
|
|
BX_DEBUG(("s.last_usec=%llu",BX_PIT_THIS s.last_usec));
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_DEBUG(("s.timer_id=%d",BX_PIT_THIS s.timer_handle[0]));
|
|
|
|
BX_DEBUG(("s.timer.get_next_event_time=%d",BX_PIT_THIS s.timer.get_next_event_time()));
|
|
|
|
BX_DEBUG(("s.last_next_event_time=%d",BX_PIT_THIS s.last_next_event_time));
|
|
|
|
|
2001-06-11 07:09:40 +04:00
|
|
|
return(1);
|
|
|
|
}
|
|
|
|
|
2002-08-27 23:54:46 +04:00
|
|
|
void
|
|
|
|
bx_pit_c::reset(unsigned type)
|
|
|
|
{
|
|
|
|
}
|
2001-06-11 07:09:40 +04:00
|
|
|
|
2001-08-18 07:28:23 +04:00
|
|
|
void
|
|
|
|
bx_pit_c::timer_handler(void *this_ptr) {
|
|
|
|
bx_pit_c * class_ptr = (bx_pit_c *) this_ptr;
|
|
|
|
|
|
|
|
class_ptr->handle_timer();
|
|
|
|
}
|
|
|
|
|
|
|
|
void
|
|
|
|
bx_pit_c::handle_timer() {
|
2003-04-04 01:59:20 +04:00
|
|
|
Bit64u my_time_usec = bx_virt_timer.time_usec();
|
|
|
|
Bit64u time_passed = my_time_usec-BX_PIT_THIS s.last_usec;
|
2001-08-18 07:28:23 +04:00
|
|
|
Bit32u time_passed32 = time_passed;
|
|
|
|
|
|
|
|
BX_DEBUG(("pit: entering timer handler"));
|
|
|
|
|
2002-01-31 20:18:38 +03:00
|
|
|
if(time_passed32) {
|
|
|
|
periodic(time_passed32);
|
2001-08-18 07:28:23 +04:00
|
|
|
}
|
|
|
|
BX_PIT_THIS s.last_usec=BX_PIT_THIS s.last_usec + time_passed;
|
|
|
|
if(time_passed ||
|
|
|
|
(BX_PIT_THIS s.last_next_event_time
|
|
|
|
!= BX_PIT_THIS s.timer.get_next_event_time())
|
|
|
|
) {
|
|
|
|
BX_DEBUG(("pit: RESETting timer."));
|
2003-02-18 19:54:48 +03:00
|
|
|
bx_virt_timer.deactivate_timer(BX_PIT_THIS s.timer_handle[0]);
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_DEBUG(("deactivated timer."));
|
|
|
|
if(BX_PIT_THIS s.timer.get_next_event_time()) {
|
2003-02-18 19:54:48 +03:00
|
|
|
bx_virt_timer.activate_timer(BX_PIT_THIS s.timer_handle[0],
|
2002-09-23 07:49:39 +04:00
|
|
|
BX_MAX(1,TICKS_TO_USEC(BX_PIT_THIS s.timer.get_next_event_time())),
|
2001-08-18 07:28:23 +04:00
|
|
|
0);
|
|
|
|
BX_DEBUG(("activated timer."));
|
|
|
|
}
|
|
|
|
BX_PIT_THIS s.last_next_event_time = BX_PIT_THIS s.timer.get_next_event_time();
|
|
|
|
}
|
2003-01-05 04:37:21 +03:00
|
|
|
BX_DEBUG(("s.last_usec=%llu",BX_PIT_THIS s.last_usec));
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_DEBUG(("s.timer_id=%d",BX_PIT_THIS s.timer_handle[0]));
|
|
|
|
BX_DEBUG(("s.timer.get_next_event_time=%x",BX_PIT_THIS s.timer.get_next_event_time()));
|
|
|
|
BX_DEBUG(("s.last_next_event_time=%d",BX_PIT_THIS s.last_next_event_time));
|
|
|
|
}
|
|
|
|
|
2001-06-11 07:09:40 +04:00
|
|
|
|
|
|
|
// static IO port read callback handler
|
|
|
|
// redirects to non-static class handler to avoid virtual functions
|
|
|
|
|
|
|
|
Bit32u
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c::read_handler(void *this_ptr, Bit32u address, unsigned io_len)
|
2001-06-11 07:09:40 +04:00
|
|
|
{
|
|
|
|
#if !BX_USE_PIT_SMF
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c *class_ptr = (bx_pit_c *) this_ptr;
|
2001-06-11 07:09:40 +04:00
|
|
|
|
|
|
|
return( class_ptr->read(address, io_len) );
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
Bit32u
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c::read( Bit32u address, unsigned int io_len )
|
2001-06-11 07:09:40 +04:00
|
|
|
{
|
|
|
|
#else
|
|
|
|
UNUSED(this_ptr);
|
|
|
|
#endif // !BX_USE_PIT_SMF
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_DEBUG(("pit: entering read handler"));
|
|
|
|
|
|
|
|
handle_timer();
|
|
|
|
|
2003-04-04 01:59:20 +04:00
|
|
|
Bit64u my_time_usec = bx_virt_timer.time_usec();
|
|
|
|
|
2001-06-11 07:09:40 +04:00
|
|
|
if (io_len > 1)
|
|
|
|
BX_PANIC(("pit: io read from port %04x, len=%u", (unsigned) address,
|
|
|
|
(unsigned) io_len));
|
|
|
|
|
|
|
|
if (bx_dbg.pit)
|
|
|
|
BX_INFO(("pit: io read from port %04x", (unsigned) address));
|
|
|
|
|
|
|
|
switch (address) {
|
|
|
|
|
|
|
|
case 0x40: /* timer 0 - system ticks */
|
2001-07-02 00:49:46 +04:00
|
|
|
return(BX_PIT_THIS s.timer.read(0));
|
2001-06-11 07:09:40 +04:00
|
|
|
break;
|
|
|
|
case 0x41: /* timer 1 read */
|
2001-07-02 00:49:46 +04:00
|
|
|
return(BX_PIT_THIS s.timer.read(1));
|
2001-06-11 07:09:40 +04:00
|
|
|
break;
|
|
|
|
case 0x42: /* timer 2 read */
|
2001-07-02 00:49:46 +04:00
|
|
|
return(BX_PIT_THIS s.timer.read(2));
|
2001-06-11 07:09:40 +04:00
|
|
|
break;
|
|
|
|
case 0x43: /* timer 1 read */
|
2001-07-02 00:49:46 +04:00
|
|
|
return(BX_PIT_THIS s.timer.read(3));
|
2001-06-11 07:09:40 +04:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x61:
|
|
|
|
/* AT, port 61h */
|
2003-04-04 01:59:20 +04:00
|
|
|
BX_PIT_THIS s.refresh_clock_div2 = ((my_time_usec / 15) & 1);
|
2001-07-02 00:49:46 +04:00
|
|
|
return( (BX_PIT_THIS s.timer.read_OUT(2)<<5) |
|
|
|
|
(BX_PIT_THIS s.refresh_clock_div2<<4) |
|
|
|
|
(BX_PIT_THIS s.speaker_data_on<<1) |
|
2001-08-30 06:02:10 +04:00
|
|
|
(BX_PIT_THIS s.timer.read_GATE(2)?1:0) );
|
2001-06-11 07:09:40 +04:00
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
BX_PANIC(("pit: unsupported io read from port %04x", address));
|
2001-08-18 07:28:23 +04:00
|
|
|
}
|
2001-06-11 07:09:40 +04:00
|
|
|
return(0); /* keep compiler happy */
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
// static IO port write callback handler
|
|
|
|
// redirects to non-static class handler to avoid virtual functions
|
|
|
|
|
|
|
|
void
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c::write_handler(void *this_ptr, Bit32u address, Bit32u dvalue, unsigned io_len)
|
2001-06-11 07:09:40 +04:00
|
|
|
{
|
|
|
|
#if !BX_USE_PIT_SMF
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c *class_ptr = (bx_pit_c *) this_ptr;
|
2001-06-11 07:09:40 +04:00
|
|
|
|
|
|
|
class_ptr->write(address, dvalue, io_len);
|
|
|
|
}
|
|
|
|
|
|
|
|
void
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c::write( Bit32u address, Bit32u dvalue,
|
2001-06-11 07:09:40 +04:00
|
|
|
unsigned int io_len )
|
|
|
|
{
|
|
|
|
#else
|
|
|
|
UNUSED(this_ptr);
|
|
|
|
#endif // !BX_USE_PIT_SMF
|
|
|
|
Bit8u value;
|
2003-04-04 01:59:20 +04:00
|
|
|
Bit64u my_time_usec = bx_virt_timer.time_usec();
|
|
|
|
Bit64u time_passed = my_time_usec-BX_PIT_THIS s.last_usec;
|
2001-08-18 07:28:23 +04:00
|
|
|
Bit32u time_passed32 = time_passed;
|
|
|
|
|
|
|
|
BX_DEBUG(("pit: entering write handler"));
|
|
|
|
|
2002-01-31 20:18:38 +03:00
|
|
|
if(time_passed32) {
|
|
|
|
periodic(time_passed32);
|
2001-08-18 07:28:23 +04:00
|
|
|
}
|
|
|
|
BX_PIT_THIS s.last_usec=BX_PIT_THIS s.last_usec + time_passed;
|
2001-06-11 07:09:40 +04:00
|
|
|
|
|
|
|
value = (Bit8u ) dvalue;
|
|
|
|
|
|
|
|
if (io_len > 1)
|
|
|
|
BX_PANIC(("pit: io write to port %04x, len=%u", (unsigned) address,
|
|
|
|
(unsigned) io_len));
|
|
|
|
|
|
|
|
if (bx_dbg.pit)
|
|
|
|
BX_INFO(("pit: write to port %04x = %02x",
|
|
|
|
(unsigned) address, (unsigned) value));
|
|
|
|
|
|
|
|
switch (address) {
|
|
|
|
case 0x40: /* timer 0: write count register */
|
2001-07-02 00:49:46 +04:00
|
|
|
BX_PIT_THIS s.timer.write(0,value);
|
2001-06-11 07:09:40 +04:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x41: /* timer 1: write count register */
|
2001-07-02 00:49:46 +04:00
|
|
|
BX_PIT_THIS s.timer.write( 1,value );
|
2001-06-11 07:09:40 +04:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x42: /* timer 2: write count register */
|
2001-07-02 00:49:46 +04:00
|
|
|
BX_PIT_THIS s.timer.write( 2,value );
|
2001-06-11 07:09:40 +04:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x43: /* timer 0-2 mode control */
|
2001-07-02 00:49:46 +04:00
|
|
|
BX_PIT_THIS s.timer.write( 3,value );
|
2001-08-18 07:28:23 +04:00
|
|
|
break;
|
2001-06-11 07:09:40 +04:00
|
|
|
|
|
|
|
case 0x61:
|
2001-07-02 00:49:46 +04:00
|
|
|
BX_PIT_THIS s.speaker_data_on = (value >> 1) & 0x01;
|
2001-06-11 07:09:40 +04:00
|
|
|
/*??? only on AT+ */
|
2001-07-02 00:49:46 +04:00
|
|
|
BX_PIT_THIS s.timer.set_GATE(2, value & 0x01);
|
2001-06-11 07:09:40 +04:00
|
|
|
#if BX_CPU_LEVEL < 2
|
|
|
|
/* ??? XT: */
|
|
|
|
bx_kbd_port61h_write(value);
|
|
|
|
#endif
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
BX_PANIC(("pit: unsupported io write to port %04x = %02x",
|
|
|
|
(unsigned) address, (unsigned) value));
|
2001-08-18 07:28:23 +04:00
|
|
|
}
|
|
|
|
|
2002-01-31 20:18:38 +03:00
|
|
|
if ((BX_PIT_THIS s.timer.read_OUT(0))==1) {
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_pic_raise_irq(0);
|
2002-01-31 20:18:38 +03:00
|
|
|
} else {
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_pic_lower_irq(0);
|
2002-01-31 20:18:38 +03:00
|
|
|
}
|
|
|
|
|
2001-08-18 07:28:23 +04:00
|
|
|
if(time_passed ||
|
|
|
|
(BX_PIT_THIS s.last_next_event_time
|
|
|
|
!= BX_PIT_THIS s.timer.get_next_event_time())
|
|
|
|
) {
|
|
|
|
BX_DEBUG(("pit: RESETting timer."));
|
2003-02-18 19:54:48 +03:00
|
|
|
bx_virt_timer.deactivate_timer(BX_PIT_THIS s.timer_handle[0]);
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_DEBUG(("deactivated timer."));
|
|
|
|
if(BX_PIT_THIS s.timer.get_next_event_time()) {
|
2003-02-18 19:54:48 +03:00
|
|
|
bx_virt_timer.activate_timer(BX_PIT_THIS s.timer_handle[0],
|
2002-09-23 07:49:39 +04:00
|
|
|
BX_MAX(1,TICKS_TO_USEC(BX_PIT_THIS s.timer.get_next_event_time())),
|
2001-08-18 07:28:23 +04:00
|
|
|
0);
|
|
|
|
BX_DEBUG(("activated timer."));
|
2001-06-11 07:09:40 +04:00
|
|
|
}
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_PIT_THIS s.last_next_event_time = BX_PIT_THIS s.timer.get_next_event_time();
|
|
|
|
}
|
2003-01-05 04:37:21 +03:00
|
|
|
BX_DEBUG(("s.last_usec=%llu",BX_PIT_THIS s.last_usec));
|
2001-08-18 07:28:23 +04:00
|
|
|
BX_DEBUG(("s.timer_id=%d",BX_PIT_THIS s.timer_handle[0]));
|
|
|
|
BX_DEBUG(("s.timer.get_next_event_time=%x",BX_PIT_THIS s.timer.get_next_event_time()));
|
|
|
|
BX_DEBUG(("s.last_next_event_time=%d",BX_PIT_THIS s.last_next_event_time));
|
|
|
|
|
2001-06-11 07:09:40 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c::SaveState( class state_file *fd )
|
2001-06-11 07:09:40 +04:00
|
|
|
{
|
|
|
|
fd->write_check ("8254 start");
|
2001-07-02 00:49:46 +04:00
|
|
|
fd->write (&BX_PIT_THIS s, sizeof (BX_PIT_THIS s));
|
2001-06-11 07:09:40 +04:00
|
|
|
fd->write_check ("8254 end");
|
|
|
|
return(0);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
int
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c::LoadState( class state_file *fd )
|
2001-06-11 07:09:40 +04:00
|
|
|
{
|
|
|
|
fd->read_check ("8254 start");
|
2001-07-02 00:49:46 +04:00
|
|
|
fd->read (&BX_PIT_THIS s, sizeof (BX_PIT_THIS s));
|
2001-06-11 07:09:40 +04:00
|
|
|
fd->read_check ("8254 end");
|
|
|
|
return(0);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
#if 0
|
|
|
|
void
|
|
|
|
bx_kbd_port61h_write(Bit8u value)
|
|
|
|
{
|
|
|
|
// PcError("KBD_PORT61H_WRITE(): not implemented yet");
|
|
|
|
UNUSED( value );
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
2002-10-25 15:44:41 +04:00
|
|
|
bx_bool
|
2001-07-02 00:49:46 +04:00
|
|
|
bx_pit_c::periodic( Bit32u usec_delta )
|
2001-06-11 07:09:40 +04:00
|
|
|
{
|
2002-10-25 15:44:41 +04:00
|
|
|
bx_bool prev_timer0_out = BX_PIT_THIS s.timer.read_OUT(0);
|
|
|
|
bx_bool want_interrupt = 0;
|
2002-01-31 20:18:38 +03:00
|
|
|
Bit32u ticks_delta = 0;
|
|
|
|
|
2002-09-01 19:38:29 +04:00
|
|
|
#ifdef BX_SCHEDULED_DIE_TIME
|
2003-02-24 01:55:50 +03:00
|
|
|
if (bx_pc_system.time_ticks() > BX_SCHEDULED_DIE_TIME) {
|
2002-09-01 19:38:29 +04:00
|
|
|
BX_ERROR (("ticks exceeded scheduled die time, quitting"));
|
|
|
|
BX_EXIT (2);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2002-10-28 08:55:47 +03:00
|
|
|
if (BX_PIT_THIS s.use_realtime) {
|
2002-09-23 06:20:52 +04:00
|
|
|
#if BX_HAVE_REALTIME_USEC
|
2002-12-07 22:51:42 +03:00
|
|
|
Bit64u real_time_delta = GET_PIT_REALTIME64_USEC() - BX_PIT_THIS s.last_time;
|
2002-09-21 08:02:51 +04:00
|
|
|
Bit64u real_time_total = real_time_delta + BX_PIT_THIS s.total_sec;
|
|
|
|
Bit64u em_time_delta = (Bit64u)usec_delta + (Bit64u)BX_PIT_THIS s.stored_delta;
|
2002-12-07 22:17:01 +03:00
|
|
|
if(real_time_delta) {
|
2002-12-07 23:01:10 +03:00
|
|
|
BX_PIT_THIS s.last_realtime_delta = real_time_delta;
|
|
|
|
BX_PIT_THIS s.last_realtime_ticks = BX_PIT_THIS s.total_ticks;
|
2002-12-07 22:17:01 +03:00
|
|
|
}
|
2002-09-21 08:02:51 +04:00
|
|
|
BX_PIT_THIS s.ticks_per_second = TICKS_PER_SECOND;
|
|
|
|
|
|
|
|
//Start out with the number of ticks we would like
|
|
|
|
// to have to line up with real time.
|
|
|
|
ticks_delta = REAL_USEC_TO_TICKS(real_time_total) - BX_PIT_THIS s.total_ticks;
|
|
|
|
if(REAL_USEC_TO_TICKS(real_time_total) < BX_PIT_THIS s.total_ticks) {
|
|
|
|
//This slows us down if we're already ahead.
|
|
|
|
// probably only an issue on startup, but it solves some problems.
|
|
|
|
ticks_delta = 0;
|
|
|
|
}
|
2002-12-07 23:01:10 +03:00
|
|
|
if(ticks_delta + BX_PIT_THIS s.total_ticks - BX_PIT_THIS s.last_realtime_ticks > REAL_USEC_TO_TICKS(F2I(MAX_MULT * I2F(BX_PIT_THIS s.last_realtime_delta)))) {
|
2002-09-21 08:02:51 +04:00
|
|
|
//This keeps us from going too fast in relation to real time.
|
2002-12-07 23:01:10 +03:00
|
|
|
ticks_delta = REAL_USEC_TO_TICKS(F2I(MAX_MULT * I2F(BX_PIT_THIS s.last_realtime_delta))) + BX_PIT_THIS s.last_realtime_ticks - BX_PIT_THIS s.total_ticks;
|
2002-12-05 20:43:00 +03:00
|
|
|
BX_PIT_THIS s.ticks_per_second = F2I(MAX_MULT * I2F(TICKS_PER_SECOND));
|
2002-09-21 08:02:51 +04:00
|
|
|
}
|
|
|
|
if(ticks_delta > em_time_delta * TICKS_PER_SECOND / MIN_USEC_PER_SECOND) {
|
|
|
|
//This keeps us from having too few instructions between ticks.
|
|
|
|
ticks_delta = em_time_delta * TICKS_PER_SECOND / MIN_USEC_PER_SECOND;
|
|
|
|
}
|
|
|
|
if(ticks_delta > BX_PIT_THIS s.timer.get_next_event_time()) {
|
|
|
|
//This keeps us from missing ticks.
|
|
|
|
ticks_delta = BX_PIT_THIS s.timer.get_next_event_time();
|
|
|
|
}
|
2002-09-21 03:10:55 +04:00
|
|
|
|
2002-09-21 08:02:51 +04:00
|
|
|
if(ticks_delta) {
|
2002-10-31 02:54:29 +03:00
|
|
|
# if DEBUG_REALTIME_WITH_PRINTF
|
2002-09-21 08:02:51 +04:00
|
|
|
if(((BX_PIT_THIS s.last_time + real_time_delta) / USEC_PER_SECOND) > (BX_PIT_THIS s.last_time / USEC_PER_SECOND)) {
|
2002-12-04 22:51:51 +03:00
|
|
|
Bit64u temp1, temp2, temp3, temp4;
|
|
|
|
temp1 = (Bit64u) BX_PIT_THIS s.total_sec;
|
|
|
|
temp2 = REAL_USEC_TO_TICKS(BX_PIT_THIS s.total_sec);
|
|
|
|
temp3 = (Bit64u)BX_PIT_THIS s.total_ticks;
|
|
|
|
temp4 = (Bit64u)(REAL_USEC_TO_TICKS(BX_PIT_THIS s.total_sec) - BX_PIT_THIS s.total_ticks);
|
|
|
|
printf("useconds: %llu, ",temp1);
|
|
|
|
printf("expect ticks: %llu, ",temp2);
|
|
|
|
printf("ticks: %llu, ",temp3);
|
|
|
|
printf("diff: %llu\n",temp4);
|
2002-09-21 08:02:51 +04:00
|
|
|
}
|
2002-10-30 01:26:32 +03:00
|
|
|
# endif
|
2002-09-21 08:02:51 +04:00
|
|
|
BX_PIT_THIS s.last_time += real_time_delta;
|
|
|
|
BX_PIT_THIS s.total_sec += real_time_delta;
|
|
|
|
BX_PIT_THIS s.last_sec_usec += em_time_delta;
|
|
|
|
// BX_PIT_THIS s.total_usec += em_time_delta;
|
|
|
|
BX_PIT_THIS s.stored_delta = 0;
|
|
|
|
BX_PIT_THIS s.total_ticks += ticks_delta;
|
|
|
|
} else {
|
|
|
|
BX_PIT_THIS s.stored_delta = em_time_delta;
|
|
|
|
}
|
2002-09-21 03:10:55 +04:00
|
|
|
|
2002-12-07 22:17:01 +03:00
|
|
|
|
2002-09-21 08:02:51 +04:00
|
|
|
Bit64u a,b;
|
|
|
|
a=(BX_PIT_THIS s.usec_per_second);
|
2002-12-04 22:51:51 +03:00
|
|
|
if(real_time_delta) {
|
2002-12-07 22:17:01 +03:00
|
|
|
//FIXME
|
2002-12-07 23:01:10 +03:00
|
|
|
Bit64u em_realtime_delta = BX_PIT_THIS s.last_sec_usec + BX_PIT_THIS s.stored_delta - BX_PIT_THIS s.em_last_realtime;
|
2002-12-07 22:17:01 +03:00
|
|
|
b=((Bit64u)USEC_PER_SECOND * em_realtime_delta / real_time_delta);
|
2002-12-07 23:01:10 +03:00
|
|
|
BX_PIT_THIS s.em_last_realtime = BX_PIT_THIS s.last_sec_usec + BX_PIT_THIS s.stored_delta;
|
2002-12-04 22:51:51 +03:00
|
|
|
} else {
|
|
|
|
b=a;
|
|
|
|
}
|
2002-09-21 08:02:51 +04:00
|
|
|
BX_PIT_THIS s.usec_per_second = ALPHA_LOWER(a,b);
|
2002-09-21 03:10:55 +04:00
|
|
|
#else
|
2002-09-21 08:02:51 +04:00
|
|
|
ticks_delta=(Bit32u)(USEC_TO_TICKS(usec_delta));
|
|
|
|
if((BX_PIT_THIS s.total_ticks + ticks_delta) < (BX_PIT_THIS s.max_ticks)) {
|
2002-05-21 01:53:26 +04:00
|
|
|
BX_PIT_THIS s.total_ticks += ticks_delta;
|
2002-09-21 08:02:51 +04:00
|
|
|
} else {
|
|
|
|
if(BX_PIT_THIS s.total_ticks >= (BX_PIT_THIS s.max_ticks)) {
|
|
|
|
ticks_delta = 0;
|
|
|
|
} else {
|
|
|
|
ticks_delta = (BX_PIT_THIS s.max_ticks) - BX_PIT_THIS s.total_ticks;
|
|
|
|
BX_PIT_THIS s.total_ticks += ticks_delta;
|
|
|
|
}
|
2002-05-21 01:53:26 +04:00
|
|
|
}
|
2002-09-21 08:02:51 +04:00
|
|
|
second_update_data();
|
2002-09-21 03:10:55 +04:00
|
|
|
#endif
|
2002-09-21 08:02:51 +04:00
|
|
|
} else {
|
|
|
|
BX_PIT_THIS s.total_usec += usec_delta;
|
|
|
|
ticks_delta=(Bit32u)((USEC_TO_TICKS((Bit64u)(BX_PIT_THIS s.total_usec)))-BX_PIT_THIS s.total_ticks);
|
|
|
|
BX_PIT_THIS s.total_ticks += ticks_delta;
|
2002-01-31 20:18:38 +03:00
|
|
|
|
2002-10-31 02:54:29 +03:00
|
|
|
while ((BX_PIT_THIS s.total_ticks >= TICKS_PER_SECOND) && (BX_PIT_THIS s.total_usec >= USEC_PER_SECOND)) {
|
|
|
|
BX_PIT_THIS s.total_ticks -= TICKS_PER_SECOND;
|
|
|
|
BX_PIT_THIS s.total_usec -= USEC_PER_SECOND;
|
2002-09-21 08:02:51 +04:00
|
|
|
}
|
2002-01-31 20:18:38 +03:00
|
|
|
}
|
2001-06-11 07:09:40 +04:00
|
|
|
|
2001-10-11 17:01:27 +04:00
|
|
|
while(ticks_delta>0) {
|
2001-07-02 00:49:46 +04:00
|
|
|
Bit32u maxchange=BX_PIT_THIS s.timer.get_next_event_time();
|
2001-06-28 02:25:24 +04:00
|
|
|
Bit32u timedelta=maxchange;
|
2001-10-11 17:01:27 +04:00
|
|
|
if((maxchange==0) || (maxchange>ticks_delta)) {
|
|
|
|
timedelta=ticks_delta;
|
2001-06-28 02:25:24 +04:00
|
|
|
}
|
2001-07-02 00:49:46 +04:00
|
|
|
BX_PIT_THIS s.timer.clock_all(timedelta);
|
2002-01-31 20:18:38 +03:00
|
|
|
if ( (prev_timer0_out==0) ) {
|
2002-01-31 20:26:26 +03:00
|
|
|
if ((BX_PIT_THIS s.timer.read_OUT(0))==1) {
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_pic_raise_irq(0);
|
2002-01-31 20:26:26 +03:00
|
|
|
prev_timer0_out=1;
|
|
|
|
}
|
2002-01-31 20:18:38 +03:00
|
|
|
} else {
|
2002-01-31 20:26:26 +03:00
|
|
|
if ((BX_PIT_THIS s.timer.read_OUT(0))==0) {
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_pic_lower_irq(0);
|
2002-01-31 20:26:26 +03:00
|
|
|
prev_timer0_out=0;
|
|
|
|
}
|
2001-06-11 07:09:40 +04:00
|
|
|
}
|
2001-07-02 00:49:46 +04:00
|
|
|
prev_timer0_out=BX_PIT_THIS s.timer.read_OUT(0);
|
2001-10-11 17:01:27 +04:00
|
|
|
ticks_delta-=timedelta;
|
2001-06-11 07:09:40 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
return(want_interrupt);
|
|
|
|
}
|
2001-07-02 00:49:46 +04:00
|
|
|
|
2002-02-08 00:22:55 +03:00
|
|
|
|
2002-10-31 02:54:29 +03:00
|
|
|
#if !BX_HAVE_REALTIME_USEC
|
2002-02-08 00:22:55 +03:00
|
|
|
void
|
|
|
|
bx_pit_c::second_update_data(void) {
|
2003-04-04 01:59:20 +04:00
|
|
|
Bit64u my_time_usec = bx_virt_timer.time_usec();
|
2002-09-20 08:42:25 +04:00
|
|
|
Bit64u timediff;
|
|
|
|
timediff=((time(NULL)*TIME_MULTIPLIER/TIME_DIVIDER)*USEC_PER_SECOND)-BX_PIT_THIS s.last_time;
|
2002-02-08 00:22:55 +03:00
|
|
|
BX_PIT_THIS s.last_time += timediff;
|
|
|
|
if(timediff) {
|
|
|
|
Bit64s tickstemp;
|
|
|
|
|
|
|
|
BX_PIT_THIS s.total_sec += timediff;
|
|
|
|
|
2002-09-23 07:49:39 +04:00
|
|
|
BX_PIT_THIS s.max_ticks = BX_MIN( (((BX_PIT_THIS s.total_sec)*(Bit64u)(TICKS_PER_SECOND))/USEC_PER_SECOND) + AHEAD_CEILING , BX_PIT_THIS s.total_ticks + (Bit64u)(TICKS_PER_SECOND*MAX_MULT) );
|
2002-05-21 01:53:26 +04:00
|
|
|
|
2002-02-09 01:27:51 +03:00
|
|
|
#if DEBUG_REALTIME_WITH_PRINTF
|
2002-12-08 07:48:52 +03:00
|
|
|
printf("timediff: %llu, total_sec: %llu, total_ticks: %llu\n",timediff, BX_PIT_THIS s.total_sec, BX_PIT_THIS s.total_ticks);
|
2002-02-09 01:27:51 +03:00
|
|
|
#endif
|
2002-02-08 00:22:55 +03:00
|
|
|
|
|
|
|
tickstemp =
|
2002-09-20 08:42:25 +04:00
|
|
|
((((BX_PIT_THIS s.total_sec)*TICKS_PER_SECOND)/USEC_PER_SECOND)-BX_PIT_THIS s.total_ticks)
|
2002-02-08 00:22:55 +03:00
|
|
|
+ TICKS_PER_SECOND;
|
|
|
|
|
|
|
|
// while((BX_PIT_THIS s.total_sec >= 0) && (BX_PIT_THIS s.total_ticks >= TICKS_PER_SECOND)) {
|
|
|
|
// BX_PIT_THIS s.total_sec -= 1;
|
|
|
|
// BX_PIT_THIS s.total_ticks -= TICKS_PER_SECOND;
|
|
|
|
// }
|
|
|
|
|
2002-02-08 08:18:14 +03:00
|
|
|
if(tickstemp > (TICKS_PER_SECOND*MAX_MULT)) {
|
2002-02-09 01:27:51 +03:00
|
|
|
#if DEBUG_REALTIME_WITH_PRINTF
|
2002-05-21 01:53:26 +04:00
|
|
|
if (tickstemp>(2*TICKS_PER_SECOND)) {
|
2002-12-08 07:48:52 +03:00
|
|
|
printf("Running WAY too slow. tps:%llu\n",tickstemp);
|
2002-05-21 01:53:26 +04:00
|
|
|
} else {
|
2002-12-08 07:48:52 +03:00
|
|
|
printf("Running slow. tps:%llu\n",tickstemp);
|
2002-05-21 01:53:26 +04:00
|
|
|
}
|
2002-02-09 01:27:51 +03:00
|
|
|
#endif
|
2002-05-21 01:53:26 +04:00
|
|
|
tickstemp = (Bit64u)(TICKS_PER_SECOND*MAX_MULT);
|
2002-02-09 01:27:51 +03:00
|
|
|
#if DEBUG_REALTIME_WITH_PRINTF
|
2002-12-08 07:48:52 +03:00
|
|
|
printf("..................new tps:%llu\n",tickstemp);
|
2002-02-09 01:27:51 +03:00
|
|
|
#endif
|
2002-02-08 08:18:14 +03:00
|
|
|
} else if(tickstemp < (TICKS_PER_SECOND*MIN_MULT)) {
|
2002-02-09 01:27:51 +03:00
|
|
|
#if DEBUG_REALTIME_WITH_PRINTF
|
2002-05-21 01:53:26 +04:00
|
|
|
if(tickstemp<0) {
|
2002-12-08 07:48:52 +03:00
|
|
|
printf("Running WAY too fast. tps:%llu\n",tickstemp);
|
2002-05-21 01:53:26 +04:00
|
|
|
} else {
|
2002-12-08 07:48:52 +03:00
|
|
|
printf("Running fast. tps:%llu\n",tickstemp);
|
2002-05-21 01:53:26 +04:00
|
|
|
}
|
2002-02-09 01:27:51 +03:00
|
|
|
#endif
|
2002-05-21 01:53:26 +04:00
|
|
|
tickstemp = (Bit64u)(TICKS_PER_SECOND*MIN_MULT);
|
2002-02-09 01:27:51 +03:00
|
|
|
#if DEBUG_REALTIME_WITH_PRINTF
|
2002-12-08 07:48:52 +03:00
|
|
|
printf("..................new tps:%llu\n",tickstemp);
|
2002-02-09 01:27:51 +03:00
|
|
|
#endif
|
2002-02-08 00:22:55 +03:00
|
|
|
}
|
|
|
|
|
|
|
|
BX_PIT_THIS s.ticks_per_second = tickstemp;
|
|
|
|
|
2003-04-04 01:59:20 +04:00
|
|
|
// BX_PIT_THIS s.usec_per_second = ALPHA_LOWER(BX_PIT_THIS s.usec_per_second,((my_time_usec-BX_PIT_THIS s.last_sec_usec)*USEC_PER_SECOND/timediff));
|
|
|
|
BX_PIT_THIS s.usec_per_second = ((my_time_usec-BX_PIT_THIS s.last_sec_usec)*USEC_PER_SECOND/timediff);
|
2002-09-23 07:49:39 +04:00
|
|
|
BX_PIT_THIS s.usec_per_second = BX_MAX(BX_PIT_THIS s.usec_per_second , MIN_USEC_PER_SECOND);
|
2003-04-04 01:59:20 +04:00
|
|
|
BX_PIT_THIS s.last_sec_usec = my_time_usec;
|
2002-02-09 01:27:51 +03:00
|
|
|
#if DEBUG_REALTIME_WITH_PRINTF
|
2002-12-08 07:48:52 +03:00
|
|
|
printf("Parms: ticks_per_second=%llu, usec_per_second=%llu\n",BX_PIT_THIS s.ticks_per_second, BX_PIT_THIS s.usec_per_second);
|
2003-04-04 01:59:20 +04:00
|
|
|
printf("total_usec: %llu\n", my_time_usec);
|
2002-02-09 01:27:51 +03:00
|
|
|
#endif
|
2002-02-08 00:22:55 +03:00
|
|
|
}
|
|
|
|
}
|
2002-10-31 02:54:29 +03:00
|
|
|
#endif // #if !BX_HAVE_REALTIME_USEC
|
2001-08-16 00:23:58 +04:00
|
|
|
#endif // #if BX_USE_NEW_PIT
|