Search
lxdream.org :: lxdream/src/pvr2/pvr2.c
lxdream 0.9.1
released Jun 29
Download Now
filename src/pvr2/pvr2.c
changeset 153:3d4091e2b136
prev151:3d3135644b8e
next159:406161fea392
author nkeynes
date Thu Jun 15 10:25:45 2006 +0000 (17 years ago)
permissions -rw-r--r--
last change Add P4 I/O tracing
Add ability to set I/O trace by region address
file annotate diff log raw
nkeynes@31
     1
/**
nkeynes@153
     2
 * $Id: pvr2.c,v 1.25 2006-05-24 11:48:58 nkeynes Exp $
nkeynes@31
     3
 *
nkeynes@133
     4
 * PVR2 (Video) Core module implementation and MMIO registers.
nkeynes@31
     5
 *
nkeynes@31
     6
 * Copyright (c) 2005 Nathan Keynes.
nkeynes@31
     7
 *
nkeynes@31
     8
 * This program is free software; you can redistribute it and/or modify
nkeynes@31
     9
 * it under the terms of the GNU General Public License as published by
nkeynes@31
    10
 * the Free Software Foundation; either version 2 of the License, or
nkeynes@31
    11
 * (at your option) any later version.
nkeynes@31
    12
 *
nkeynes@31
    13
 * This program is distributed in the hope that it will be useful,
nkeynes@31
    14
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
nkeynes@31
    15
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
nkeynes@31
    16
 * GNU General Public License for more details.
nkeynes@31
    17
 */
nkeynes@35
    18
#define MODULE pvr2_module
nkeynes@31
    19
nkeynes@1
    20
#include "dream.h"
nkeynes@144
    21
#include "display.h"
nkeynes@1
    22
#include "mem.h"
nkeynes@1
    23
#include "asic.h"
nkeynes@103
    24
#include "pvr2/pvr2.h"
nkeynes@56
    25
#include "sh4/sh4core.h"
nkeynes@1
    26
#define MMIO_IMPL
nkeynes@103
    27
#include "pvr2/pvr2mmio.h"
nkeynes@1
    28
nkeynes@1
    29
char *video_base;
nkeynes@1
    30
nkeynes@133
    31
static void pvr2_init( void );
nkeynes@133
    32
static void pvr2_reset( void );
nkeynes@133
    33
static uint32_t pvr2_run_slice( uint32_t );
nkeynes@133
    34
static void pvr2_save_state( FILE *f );
nkeynes@133
    35
static int pvr2_load_state( FILE *f );
nkeynes@133
    36
nkeynes@94
    37
void pvr2_display_frame( void );
nkeynes@94
    38
nkeynes@133
    39
struct dreamcast_module pvr2_module = { "PVR2", pvr2_init, pvr2_reset, NULL, 
nkeynes@133
    40
					pvr2_run_slice, NULL,
nkeynes@133
    41
					pvr2_save_state, pvr2_load_state };
nkeynes@133
    42
nkeynes@103
    43
nkeynes@144
    44
display_driver_t display_driver = NULL;
nkeynes@15
    45
nkeynes@103
    46
struct video_timing {
nkeynes@103
    47
    int fields_per_second;
nkeynes@103
    48
    int total_lines;
nkeynes@108
    49
    int retrace_lines;
nkeynes@103
    50
    int line_time_ns;
nkeynes@103
    51
};
nkeynes@103
    52
nkeynes@133
    53
struct video_timing pal_timing = { 50, 625, 65, 32000 };
nkeynes@108
    54
struct video_timing ntsc_timing= { 60, 525, 65, 31746 };
nkeynes@103
    55
nkeynes@133
    56
struct pvr2_state {
nkeynes@133
    57
    uint32_t frame_count;
nkeynes@133
    58
    uint32_t line_count;
nkeynes@133
    59
    uint32_t line_remainder;
nkeynes@133
    60
    uint32_t irq_vpos1;
nkeynes@133
    61
    uint32_t irq_vpos2;
nkeynes@133
    62
    gboolean retrace;
nkeynes@133
    63
    struct video_timing timing;
nkeynes@133
    64
} pvr2_state;
nkeynes@15
    65
nkeynes@133
    66
struct video_buffer video_buffer[2];
nkeynes@133
    67
int video_buffer_idx = 0;
nkeynes@133
    68
nkeynes@133
    69
static void pvr2_init( void )
nkeynes@1
    70
{
nkeynes@1
    71
    register_io_region( &mmio_region_PVR2 );
nkeynes@85
    72
    register_io_region( &mmio_region_PVR2PAL );
nkeynes@56
    73
    register_io_region( &mmio_region_PVR2TA );
nkeynes@1
    74
    video_base = mem_get_region_by_name( MEM_REGION_VIDEO );
nkeynes@133
    75
    texcache_init();
nkeynes@133
    76
    pvr2_reset();
nkeynes@133
    77
}
nkeynes@133
    78
nkeynes@133
    79
static void pvr2_reset( void )
nkeynes@133
    80
{
nkeynes@133
    81
    pvr2_state.line_count = 0;
nkeynes@133
    82
    pvr2_state.line_remainder = 0;
nkeynes@133
    83
    pvr2_state.irq_vpos1 = 0;
nkeynes@133
    84
    pvr2_state.irq_vpos2 = 0;
nkeynes@133
    85
    pvr2_state.retrace = FALSE;
nkeynes@133
    86
    pvr2_state.timing = ntsc_timing;
nkeynes@133
    87
    video_buffer_idx = 0;
nkeynes@133
    88
    
nkeynes@133
    89
    pvr2_ta_init();
nkeynes@107
    90
    pvr2_render_init();
nkeynes@133
    91
    texcache_flush();
nkeynes@133
    92
}
nkeynes@133
    93
nkeynes@133
    94
static void pvr2_save_state( FILE *f )
nkeynes@133
    95
{
nkeynes@133
    96
    fwrite( &pvr2_state, sizeof(pvr2_state), 1, f );
nkeynes@133
    97
}
nkeynes@133
    98
nkeynes@133
    99
static int pvr2_load_state( FILE *f )
nkeynes@133
   100
{
nkeynes@153
   101
    if( fread( &pvr2_state, sizeof(pvr2_state), 1, f ) != 1 )
nkeynes@153
   102
	return 1;
nkeynes@153
   103
    return 0;
nkeynes@133
   104
}
nkeynes@133
   105
nkeynes@133
   106
static uint32_t pvr2_run_slice( uint32_t nanosecs ) 
nkeynes@133
   107
{
nkeynes@133
   108
    pvr2_state.line_remainder += nanosecs;
nkeynes@133
   109
    while( pvr2_state.line_remainder >= pvr2_state.timing.line_time_ns ) {
nkeynes@133
   110
	pvr2_state.line_remainder -= pvr2_state.timing.line_time_ns;
nkeynes@133
   111
nkeynes@133
   112
	pvr2_state.line_count++;
nkeynes@133
   113
	if( pvr2_state.line_count == pvr2_state.timing.total_lines ) {
nkeynes@133
   114
	    asic_event( EVENT_RETRACE );
nkeynes@133
   115
	    pvr2_state.line_count = 0;
nkeynes@133
   116
	    pvr2_state.retrace = TRUE;
nkeynes@133
   117
	}
nkeynes@133
   118
nkeynes@133
   119
	if( pvr2_state.line_count == pvr2_state.irq_vpos1 ) {
nkeynes@133
   120
	    asic_event( EVENT_SCANLINE1 );
nkeynes@133
   121
	} 
nkeynes@133
   122
	if( pvr2_state.line_count == pvr2_state.irq_vpos2 ) {
nkeynes@133
   123
	    asic_event( EVENT_SCANLINE2 );
nkeynes@133
   124
	}
nkeynes@133
   125
nkeynes@133
   126
	if( pvr2_state.line_count == pvr2_state.timing.retrace_lines ) {
nkeynes@133
   127
	    if( pvr2_state.retrace ) {
nkeynes@133
   128
		pvr2_display_frame();
nkeynes@133
   129
		pvr2_state.retrace = FALSE;
nkeynes@133
   130
	    }
nkeynes@133
   131
	}
nkeynes@133
   132
    }
nkeynes@133
   133
    return nanosecs;
nkeynes@133
   134
}
nkeynes@133
   135
nkeynes@133
   136
int pvr2_get_frame_count() 
nkeynes@133
   137
{
nkeynes@133
   138
    return pvr2_state.frame_count;
nkeynes@106
   139
}
nkeynes@106
   140
nkeynes@103
   141
/**
nkeynes@1
   142
 * Display the next frame, copying the current contents of video ram to
nkeynes@1
   143
 * the window. If the video configuration has changed, first recompute the
nkeynes@1
   144
 * new frame size/depth.
nkeynes@1
   145
 */
nkeynes@94
   146
void pvr2_display_frame( void )
nkeynes@1
   147
{
nkeynes@103
   148
    uint32_t display_addr = MMIO_READ( PVR2, DISPADDR1 );
nkeynes@103
   149
    
nkeynes@94
   150
    int dispsize = MMIO_READ( PVR2, DISPSIZE );
nkeynes@94
   151
    int dispmode = MMIO_READ( PVR2, DISPMODE );
nkeynes@103
   152
    int vidcfg = MMIO_READ( PVR2, DISPCFG );
nkeynes@94
   153
    int vid_stride = ((dispsize & DISPSIZE_MODULO) >> 20) - 1;
nkeynes@94
   154
    int vid_lpf = ((dispsize & DISPSIZE_LPF) >> 10) + 1;
nkeynes@94
   155
    int vid_ppl = ((dispsize & DISPSIZE_PPL)) + 1;
nkeynes@103
   156
    gboolean bEnabled = (dispmode & DISPMODE_DE) && (vidcfg & DISPCFG_VO ) ? TRUE : FALSE;
nkeynes@103
   157
    gboolean interlaced = (vidcfg & DISPCFG_I ? TRUE : FALSE);
nkeynes@1
   158
    if( bEnabled ) {
nkeynes@94
   159
	video_buffer_t buffer = &video_buffer[video_buffer_idx];
nkeynes@94
   160
	video_buffer_idx = !video_buffer_idx;
nkeynes@94
   161
	video_buffer_t last = &video_buffer[video_buffer_idx];
nkeynes@94
   162
	buffer->rowstride = (vid_ppl + vid_stride) << 2;
nkeynes@133
   163
	buffer->data = video_base + MMIO_READ( PVR2, DISPADDR1 );
nkeynes@94
   164
	buffer->vres = vid_lpf;
nkeynes@94
   165
	if( interlaced ) buffer->vres <<= 1;
nkeynes@103
   166
	switch( (dispmode & DISPMODE_COL) >> 2 ) {
nkeynes@103
   167
	case 0: 
nkeynes@103
   168
	    buffer->colour_format = COLFMT_ARGB1555;
nkeynes@103
   169
	    buffer->hres = vid_ppl << 1; 
nkeynes@103
   170
	    break;
nkeynes@103
   171
	case 1: 
nkeynes@103
   172
	    buffer->colour_format = COLFMT_RGB565;
nkeynes@103
   173
	    buffer->hres = vid_ppl << 1; 
nkeynes@103
   174
	    break;
nkeynes@103
   175
	case 2:
nkeynes@103
   176
	    buffer->colour_format = COLFMT_RGB888;
nkeynes@103
   177
	    buffer->hres = (vid_ppl << 2) / 3; 
nkeynes@103
   178
	    break;
nkeynes@103
   179
	case 3: 
nkeynes@103
   180
	    buffer->colour_format = COLFMT_ARGB8888;
nkeynes@103
   181
	    buffer->hres = vid_ppl; 
nkeynes@103
   182
	    break;
nkeynes@94
   183
	}
nkeynes@94
   184
	
nkeynes@144
   185
	if( display_driver != NULL ) {
nkeynes@94
   186
	    if( buffer->hres != last->hres ||
nkeynes@94
   187
		buffer->vres != last->vres ||
nkeynes@94
   188
		buffer->colour_format != last->colour_format) {
nkeynes@144
   189
		display_driver->set_display_format( buffer->hres, buffer->vres,
nkeynes@103
   190
						  buffer->colour_format );
nkeynes@94
   191
	    }
nkeynes@103
   192
	    if( MMIO_READ( PVR2, DISPCFG2 ) & 0x08 ) { /* Blanked */
nkeynes@100
   193
		uint32_t colour = MMIO_READ( PVR2, DISPBORDER );
nkeynes@144
   194
		display_driver->display_blank_frame( colour );
nkeynes@103
   195
	    } else if( !pvr2_render_display_frame( PVR2_RAM_BASE + display_addr ) ) {
nkeynes@144
   196
		display_driver->display_frame( buffer );
nkeynes@94
   197
	    }
nkeynes@65
   198
	}
nkeynes@1
   199
    } else {
nkeynes@94
   200
	video_buffer_idx = 0;
nkeynes@94
   201
	video_buffer[0].hres = video_buffer[0].vres = 0;
nkeynes@1
   202
    }
nkeynes@133
   203
    pvr2_state.frame_count++;
nkeynes@1
   204
}
nkeynes@1
   205
nkeynes@1
   206
void mmio_region_PVR2_write( uint32_t reg, uint32_t val )
nkeynes@1
   207
{
nkeynes@1
   208
    if( reg >= 0x200 && reg < 0x600 ) { /* Fog table */
nkeynes@1
   209
        MMIO_WRITE( PVR2, reg, val );
nkeynes@1
   210
        /* I don't want to hear about these */
nkeynes@1
   211
        return;
nkeynes@1
   212
    }
nkeynes@1
   213
    
nkeynes@151
   214
    if( reg == PVRID ) {
nkeynes@151
   215
	ERROR( "Write attempted to readonly register PVRID: ", val );
nkeynes@151
   216
	return;
nkeynes@151
   217
    }
nkeynes@1
   218
    INFO( "PVR2 write to %08X <= %08X [%s: %s]", reg, val, 
nkeynes@1
   219
          MMIO_REGID(PVR2,reg), MMIO_REGDESC(PVR2,reg) );
nkeynes@108
   220
nkeynes@108
   221
    MMIO_WRITE( PVR2, reg, val );
nkeynes@1
   222
   
nkeynes@1
   223
    switch(reg) {
nkeynes@108
   224
    case DISPADDR1:
nkeynes@133
   225
	if( pvr2_state.retrace ) {
nkeynes@108
   226
	    pvr2_display_frame();
nkeynes@133
   227
	    pvr2_state.retrace = FALSE;
nkeynes@108
   228
	}
nkeynes@108
   229
	break;
nkeynes@103
   230
    case VPOS_IRQ:
nkeynes@133
   231
	pvr2_state.irq_vpos1 = (val >> 16) & 0x03FF;
nkeynes@133
   232
	pvr2_state.irq_vpos2 = val & 0x03FF;
nkeynes@103
   233
	break;
nkeynes@100
   234
    case TAINIT:
nkeynes@100
   235
	if( val & 0x80000000 )
nkeynes@100
   236
	    pvr2_ta_init();
nkeynes@100
   237
	break;
nkeynes@65
   238
    case RENDSTART:
nkeynes@65
   239
	if( val == 0xFFFFFFFF )
nkeynes@65
   240
	    pvr2_render_scene();
nkeynes@65
   241
	break;
nkeynes@1
   242
    }
nkeynes@1
   243
}
nkeynes@1
   244
nkeynes@1
   245
MMIO_REGION_READ_FN( PVR2, reg )
nkeynes@1
   246
{
nkeynes@1
   247
    switch( reg ) {
nkeynes@1
   248
        case BEAMPOS:
nkeynes@2
   249
            return sh4r.icount&0x20 ? 0x2000 : 1;
nkeynes@1
   250
        default:
nkeynes@1
   251
            return MMIO_READ( PVR2, reg );
nkeynes@1
   252
    }
nkeynes@1
   253
}
nkeynes@19
   254
nkeynes@85
   255
MMIO_REGION_DEFFNS( PVR2PAL )
nkeynes@85
   256
nkeynes@19
   257
void pvr2_set_base_address( uint32_t base ) 
nkeynes@19
   258
{
nkeynes@19
   259
    mmio_region_PVR2_write( DISPADDR1, base );
nkeynes@19
   260
}
nkeynes@56
   261
nkeynes@56
   262
nkeynes@65
   263
nkeynes@98
   264
nkeynes@56
   265
int32_t mmio_region_PVR2TA_read( uint32_t reg )
nkeynes@56
   266
{
nkeynes@56
   267
    return 0xFFFFFFFF;
nkeynes@56
   268
}
nkeynes@56
   269
nkeynes@56
   270
void mmio_region_PVR2TA_write( uint32_t reg, uint32_t val )
nkeynes@56
   271
{
nkeynes@100
   272
    pvr2_ta_write( &val, sizeof(uint32_t) );
nkeynes@56
   273
}
nkeynes@56
   274
nkeynes@85
   275
nkeynes@103
   276
void pvr2_vram64_write( sh4addr_t destaddr, char *src, uint32_t length )
nkeynes@103
   277
{
nkeynes@103
   278
    int bank_flag = (destaddr & 0x04) >> 2;
nkeynes@103
   279
    uint32_t *banks[2];
nkeynes@103
   280
    uint32_t *dwsrc;
nkeynes@103
   281
    int i;
nkeynes@65
   282
nkeynes@103
   283
    destaddr = destaddr & 0x7FFFFF;
nkeynes@103
   284
    if( destaddr + length > 0x800000 ) {
nkeynes@103
   285
	length = 0x800000 - destaddr;
nkeynes@103
   286
    }
nkeynes@103
   287
nkeynes@103
   288
    for( i=destaddr & 0xFFFFF000; i < destaddr + length; i+= PAGE_SIZE ) {
nkeynes@103
   289
	texcache_invalidate_page( i );
nkeynes@103
   290
    }
nkeynes@103
   291
nkeynes@108
   292
    banks[0] = ((uint32_t *)(video_base + ((destaddr & 0x007FFFF8) >>1)));
nkeynes@103
   293
    banks[1] = banks[0] + 0x100000;
nkeynes@108
   294
    if( bank_flag ) 
nkeynes@108
   295
	banks[0]++;
nkeynes@103
   296
    
nkeynes@103
   297
    /* Handle non-aligned start of source */
nkeynes@103
   298
    if( destaddr & 0x03 ) {
nkeynes@103
   299
	char *dest = ((char *)banks[bank_flag]) + (destaddr & 0x03);
nkeynes@103
   300
	for( i= destaddr & 0x03; i < 4 && length > 0; i++, length-- ) {
nkeynes@103
   301
	    *dest++ = *src++;
nkeynes@103
   302
	}
nkeynes@103
   303
	bank_flag = !bank_flag;
nkeynes@103
   304
    }
nkeynes@103
   305
nkeynes@103
   306
    dwsrc = (uint32_t *)src;
nkeynes@103
   307
    while( length >= 4 ) {
nkeynes@103
   308
	*banks[bank_flag]++ = *dwsrc++;
nkeynes@103
   309
	bank_flag = !bank_flag;
nkeynes@103
   310
	length -= 4;
nkeynes@103
   311
    }
nkeynes@103
   312
    
nkeynes@103
   313
    /* Handle non-aligned end of source */
nkeynes@103
   314
    if( length ) {
nkeynes@103
   315
	src = (char *)dwsrc;
nkeynes@103
   316
	char *dest = (char *)banks[bank_flag];
nkeynes@103
   317
	while( length-- > 0 ) {
nkeynes@103
   318
	    *dest++ = *src++;
nkeynes@103
   319
	}
nkeynes@103
   320
    }  
nkeynes@103
   321
nkeynes@103
   322
}
nkeynes@103
   323
nkeynes@103
   324
void pvr2_vram64_read( char *dest, sh4addr_t srcaddr, uint32_t length )
nkeynes@103
   325
{
nkeynes@103
   326
    int bank_flag = (srcaddr & 0x04) >> 2;
nkeynes@103
   327
    uint32_t *banks[2];
nkeynes@103
   328
    uint32_t *dwdest;
nkeynes@103
   329
    int i;
nkeynes@103
   330
nkeynes@103
   331
    srcaddr = srcaddr & 0x7FFFFF;
nkeynes@103
   332
    if( srcaddr + length > 0x800000 )
nkeynes@103
   333
	length = 0x800000 - srcaddr;
nkeynes@103
   334
nkeynes@108
   335
    banks[0] = ((uint32_t *)(video_base + ((srcaddr&0x007FFFF8)>>1)));
nkeynes@103
   336
    banks[1] = banks[0] + 0x100000;
nkeynes@108
   337
    if( bank_flag )
nkeynes@108
   338
	banks[0]++;
nkeynes@103
   339
    
nkeynes@103
   340
    /* Handle non-aligned start of source */
nkeynes@103
   341
    if( srcaddr & 0x03 ) {
nkeynes@103
   342
	char *src = ((char *)banks[bank_flag]) + (srcaddr & 0x03);
nkeynes@103
   343
	for( i= srcaddr & 0x03; i < 4 && length > 0; i++, length-- ) {
nkeynes@103
   344
	    *dest++ = *src++;
nkeynes@103
   345
	}
nkeynes@103
   346
	bank_flag = !bank_flag;
nkeynes@103
   347
    }
nkeynes@103
   348
nkeynes@103
   349
    dwdest = (uint32_t *)dest;
nkeynes@103
   350
    while( length >= 4 ) {
nkeynes@103
   351
	*dwdest++ = *banks[bank_flag]++;
nkeynes@103
   352
	bank_flag = !bank_flag;
nkeynes@103
   353
	length -= 4;
nkeynes@103
   354
    }
nkeynes@103
   355
    
nkeynes@103
   356
    /* Handle non-aligned end of source */
nkeynes@103
   357
    if( length ) {
nkeynes@103
   358
	dest = (char *)dwdest;
nkeynes@103
   359
	char *src = (char *)banks[bank_flag];
nkeynes@103
   360
	while( length-- > 0 ) {
nkeynes@103
   361
	    *dest++ = *src++;
nkeynes@103
   362
	}
nkeynes@103
   363
    }
nkeynes@103
   364
}
nkeynes@127
   365
nkeynes@127
   366
void pvr2_vram64_dump( sh4addr_t addr, uint32_t length, FILE *f ) 
nkeynes@127
   367
{
nkeynes@127
   368
    char tmp[length];
nkeynes@127
   369
    pvr2_vram64_read( tmp, addr, length );
nkeynes@127
   370
    fwrite_dump( tmp, length, f );
nkeynes@127
   371
}
.