src/mess/drivers/gp32.c
| r6542 | r6543 | |
| 107 | 107 | |
| 108 | 108 | static UINT32 s3c240x_clkpow_regs[0x18/4]; |
| 109 | 109 | |
| 110 | | UINT32 cpu_get_fclk( int reg) |
| 110 | static UINT32 s3c240x_get_fclk( int reg) |
| 111 | 111 | { |
| 112 | 112 | UINT32 data, mdiv, pdiv, sdiv; |
| 113 | 113 | data = s3c240x_clkpow_regs[reg]; // MPLLCON or UPLLCON |
| 114 | 114 | mdiv = (data >> 12) & 0xFF; |
| 115 | 115 | pdiv = (data >> 4) & 0x3F; |
| 116 | 116 | sdiv = (data >> 0) & 0x03; |
| 117 | | return (UINT32)((float)((mdiv + 8) * 12000000) / (float)((pdiv + 2) * (1 << sdiv))); |
| 117 | return (UINT32)((double)((mdiv + 8) * 12000000) / (double)((pdiv + 2) * (1 << sdiv))); |
| 118 | 118 | } |
| 119 | 119 | |
| 120 | | UINT32 cpu_get_hclk( int reg) |
| 120 | /* |
| 121 | static UINT32 s3c240x_get_hclk( int reg) |
| 121 | 122 | { |
| 122 | 123 | switch (s3c240x_clkpow_regs[5] & 0x3) // CLKDIVN |
| 123 | 124 | { |
| 124 | | case 0 : return cpu_get_fclk( reg) / 1; |
| 125 | | case 1 : return cpu_get_fclk( reg) / 1; |
| 126 | | case 2 : return cpu_get_fclk( reg) / 2; |
| 127 | | case 3 : return cpu_get_fclk( reg) / 2; |
| 125 | case 0 : return s3c240x_get_fclk( reg) / 1; |
| 126 | case 1 : return s3c240x_get_fclk( reg) / 1; |
| 127 | case 2 : return s3c240x_get_fclk( reg) / 2; |
| 128 | case 3 : return s3c240x_get_fclk( reg) / 2; |
| 128 | 129 | } |
| 129 | 130 | return 0; |
| 130 | 131 | } |
| 132 | */ |
| 131 | 133 | |
| 132 | | UINT32 cpu_get_pclk( int reg) |
| 134 | static UINT32 s3c240x_get_pclk( int reg) |
| 133 | 135 | { |
| 134 | 136 | switch (s3c240x_clkpow_regs[5] & 0x3) // CLKDIVN |
| 135 | 137 | { |
| 136 | | case 0 : return cpu_get_fclk( reg) / 1; |
| 137 | | case 1 : return cpu_get_fclk( reg) / 2; |
| 138 | | case 2 : return cpu_get_fclk( reg) / 2; |
| 139 | | case 3 : return cpu_get_fclk( reg) / 4; |
| 138 | case 0 : return s3c240x_get_fclk( reg) / 1; |
| 139 | case 1 : return s3c240x_get_fclk( reg) / 2; |
| 140 | case 2 : return s3c240x_get_fclk( reg) / 2; |
| 141 | case 3 : return s3c240x_get_fclk( reg) / 4; |
| 140 | 142 | } |
| 141 | 143 | return 0; |
| 142 | 144 | } |
| r6542 | r6543 | |
| 220 | 222 | const int mux_shift[] = { 0, 4, 8, 12, 16}; |
| 221 | 223 | if (ctrl_bits & 1) // timer start? |
| 222 | 224 | { |
| 223 | | UINT32 prescaler, mux, freq, cnt, cmp, tps; |
| 225 | UINT32 prescaler, mux, freq, cnt, cmp; |
| 226 | double hz; |
| 224 | 227 | logerror( "starting timer %d\n", timer); |
| 225 | 228 | prescaler = (s3c240x_timer_regs[0] >> prescaler_shift[timer]) & 0xFF; |
| 226 | 229 | mux = (s3c240x_timer_regs[1] >> mux_shift[timer]) & 0x0F; |
| 227 | | freq = cpu_get_pclk( 1) / (prescaler + 1) / mux_table[mux]; |
| 230 | freq = s3c240x_get_pclk( 1) / (prescaler + 1) / mux_table[mux]; |
| 228 | 231 | cnt = s3c240x_timer_regs[count_reg+0] & 0xFFFF; |
| 229 | 232 | if (timer != 4) |
| 230 | 233 | cmp = s3c240x_timer_regs[count_reg+1] & 0xFFFF; |
| 231 | 234 | else |
| 232 | 235 | cmp = 0; |
| 233 | | tps = freq * (cnt - cmp + 1); |
| 234 | | // logerror( "TIMER %d - FCLK=%d HCLK=%d PCLK=%d prescaler=%d div=%d freq=%d cnt=%d cmp=%d tps=%d\n", timer, cpu_get_fclk( 1), cpu_get_hclk( 1), cpu_get_pclk( 1), prescaler, mux_table[mux], freq, cnt, cmp, tps); |
| 236 | hz = (double)((prescaler + 1) * mux_table[mux]) / (cnt - cmp + 1); |
| 237 | // logerror( "TIMER %d - FCLK=%d HCLK=%d PCLK=%d prescaler=%d div=%d freq=%d cnt=%d cmp=%d hz=%f\n", timer, s3c240x_get_fclk( 1), s3c240x_get_hclk( 1), s3c240x_get_pclk( 1), prescaler, mux_table[mux], freq, cnt, cmp, hz); |
| 235 | 238 | if (ctrl_bits & 8) // auto reload |
| 236 | 239 | { |
| 237 | | timer_adjust_periodic( s3c240x_timers[timer], ATTOTIME_IN_HZ( tps), timer, ATTOTIME_IN_HZ( tps)); |
| 240 | timer_adjust_periodic( s3c240x_timers[timer], ATTOTIME_IN_HZ( hz), timer, ATTOTIME_IN_HZ( hz)); |
| 238 | 241 | } |
| 239 | 242 | else |
| 240 | 243 | { |
| 241 | | timer_adjust_oneshot( s3c240x_timers[timer], ATTOTIME_IN_HZ( tps), timer); |
| 244 | timer_adjust_oneshot( s3c240x_timers[timer], ATTOTIME_IN_HZ( hz), timer); |
| 242 | 245 | } |
| 243 | 246 | } |
| 244 | 247 | else // stopping is easy |
| r6542 | r6543 | |
| 371 | 374 | smc.busy = 0; |
| 372 | 375 | } |
| 373 | 376 | |
| 374 | | UINT8 smc_read( running_machine *machine) |
| 377 | static UINT8 smc_read( running_machine *machine) |
| 375 | 378 | { |
| 376 | 379 | const device_config *smartmedia = devtag_get_device( machine, "smartmedia"); |
| 377 | 380 | UINT8 data; |
| r6542 | r6543 | |
| 380 | 383 | return data; |
| 381 | 384 | } |
| 382 | 385 | |
| 383 | | void smc_write( running_machine *machine, UINT8 data) |
| 386 | static void smc_write( running_machine *machine, UINT8 data) |
| 384 | 387 | { |
| 385 | 388 | // logerror( "smc_write %08X\n", data); |
| 386 | 389 | if ((smc.chip) && (!smc.read)) |
| r6542 | r6543 | |
| 404 | 407 | } |
| 405 | 408 | } |
| 406 | 409 | |
| 407 | | void smc_update( running_machine *machine) |
| 410 | static void smc_update( running_machine *machine) |
| 408 | 411 | { |
| 409 | 412 | if (!smc.chip) |
| 410 | 413 | { |