nkeynes@31 | 1 | /**
|
nkeynes@561 | 2 | * $Id$
|
nkeynes@31 | 3 | *
|
nkeynes@31 | 4 | * Implements the core Maple bus, including DMA transfers to and from the bus.
|
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 maple_module
|
nkeynes@31 | 19 |
|
nkeynes@1 | 20 | #include <assert.h>
|
nkeynes@480 | 21 | #include <glib/gstrfuncs.h>
|
nkeynes@1 | 22 | #include "dream.h"
|
nkeynes@1 | 23 | #include "mem.h"
|
nkeynes@1 | 24 | #include "asic.h"
|
nkeynes@1 | 25 | #include "maple.h"
|
nkeynes@1 | 26 |
|
nkeynes@15 | 27 | void maple_init( void );
|
nkeynes@15 | 28 |
|
nkeynes@15 | 29 | struct dreamcast_module maple_module = { "Maple", maple_init, NULL, NULL, NULL,
|
nkeynes@23 | 30 | NULL, NULL, NULL };
|
nkeynes@15 | 31 |
|
nkeynes@144 | 32 | struct maple_device_class *maple_device_classes[] = { &controller_class, NULL };
|
nkeynes@144 | 33 |
|
nkeynes@15 | 34 | void maple_init( void )
|
nkeynes@15 | 35 | {
|
nkeynes@15 | 36 |
|
nkeynes@15 | 37 | }
|
nkeynes@15 | 38 |
|
nkeynes@144 | 39 | maple_device_t maple_new_device( const gchar *name )
|
nkeynes@144 | 40 | {
|
nkeynes@447 | 41 | maple_device_class_t clz = maple_get_device_class(name);
|
nkeynes@447 | 42 | if( clz != NULL ) {
|
nkeynes@447 | 43 | return clz->new_device();
|
nkeynes@447 | 44 | }
|
nkeynes@447 | 45 | return NULL;
|
nkeynes@447 | 46 | }
|
nkeynes@447 | 47 |
|
nkeynes@480 | 48 | maple_device_class_t maple_get_device_class( const gchar *name )
|
nkeynes@447 | 49 | {
|
nkeynes@144 | 50 | int i;
|
nkeynes@144 | 51 | for( i=0; maple_device_classes[i] != NULL; i++ ) {
|
nkeynes@144 | 52 | if( g_strcasecmp(maple_device_classes[i]->name, name ) == 0 )
|
nkeynes@447 | 53 | return maple_device_classes[i];
|
nkeynes@144 | 54 | }
|
nkeynes@144 | 55 | return NULL;
|
nkeynes@144 | 56 | }
|
nkeynes@144 | 57 |
|
nkeynes@447 | 58 | const struct maple_device_class **maple_get_device_classes()
|
nkeynes@447 | 59 | {
|
nkeynes@480 | 60 | return (const struct maple_device_class **)maple_device_classes;
|
nkeynes@447 | 61 | }
|
nkeynes@447 | 62 |
|
nkeynes@450 | 63 | lxdream_config_entry_t maple_get_device_config( maple_device_t dev )
|
nkeynes@144 | 64 | {
|
nkeynes@144 | 65 | if( dev->get_config == NULL )
|
nkeynes@144 | 66 | return NULL;
|
nkeynes@144 | 67 | return dev->get_config(dev);
|
nkeynes@144 | 68 | }
|
nkeynes@144 | 69 |
|
nkeynes@2 | 70 | /**
|
nkeynes@2 | 71 | * Input data looks like this:
|
nkeynes@2 | 72 | * 0: transfer control word
|
nkeynes@2 | 73 | * 0: length of data in words (not including 3 word header)
|
nkeynes@2 | 74 | * 1: low bit = lightgun mode
|
nkeynes@2 | 75 | * 2: low 2 bits = port # (0..3)
|
nkeynes@2 | 76 | * 3: 0x80 = last packet, 0x00 = normal packet
|
nkeynes@2 | 77 | * 4: output buffer address
|
nkeynes@2 | 78 | * 8: Command word
|
nkeynes@2 | 79 | * 8: command code
|
nkeynes@2 | 80 | * 9: destination address
|
nkeynes@2 | 81 | * 10: source address
|
nkeynes@2 | 82 | * 11: length of data in words (not including 3 word header)
|
nkeynes@2 | 83 | * 12: command-specific data
|
nkeynes@2 | 84 | */
|
nkeynes@2 | 85 |
|
nkeynes@2 | 86 | /**
|
nkeynes@2 | 87 | * array is [port][subperipheral], so [0][0] is main peripheral on port A,
|
nkeynes@2 | 88 | * [1][2] is the second subperipheral on port B and so on.
|
nkeynes@2 | 89 | */
|
nkeynes@2 | 90 | maple_device_t maple_devices[4][6];
|
nkeynes@2 | 91 | int maple_periph_mask[4];
|
nkeynes@2 | 92 | #define GETBYTE(n) ((uint32_t)(buf[n]))
|
nkeynes@2 | 93 | #define GETWORD(n) (*((uint32_t *)(buf+(n))))
|
nkeynes@2 | 94 | #define PUTBYTE(n,x) (buf[n] = (char)x)
|
nkeynes@2 | 95 | #define PUTWORD(n,x) (*((uint32_t *)(return_buf+(n))) = (x))
|
nkeynes@2 | 96 |
|
nkeynes@144 | 97 | maple_device_t maple_get_device( unsigned int port, unsigned int periph ) {
|
nkeynes@144 | 98 | if( port >= 4 )
|
nkeynes@144 | 99 | return NULL;
|
nkeynes@144 | 100 | if( periph >= 6 )
|
nkeynes@144 | 101 | return NULL;
|
nkeynes@144 | 102 | return maple_devices[port][periph];
|
nkeynes@144 | 103 | }
|
nkeynes@144 | 104 |
|
nkeynes@1 | 105 | void maple_handle_buffer( uint32_t address ) {
|
nkeynes@2 | 106 | unsigned char *buf = (unsigned char *)mem_get_region(address);
|
nkeynes@1 | 107 | if( buf == NULL ) {
|
nkeynes@1 | 108 | ERROR( "Invalid or unmapped buffer passed to maple (0x%08X)", address );
|
nkeynes@1 | 109 | } else {
|
nkeynes@2 | 110 | unsigned int last = 0;
|
nkeynes@2 | 111 | int i = 0, count;
|
nkeynes@2 | 112 | for( count=0; !last; count++ ) {
|
nkeynes@494 | 113 | unsigned int port, length, mode, periph, periph_id, out_length;
|
nkeynes@2 | 114 | unsigned int cmd, recv_addr, send_addr;
|
nkeynes@2 | 115 | uint32_t return_addr;
|
nkeynes@2 | 116 | unsigned char *return_buf;
|
nkeynes@1 | 117 |
|
nkeynes@2 | 118 | last = GETBYTE(3) & 0x80; /* indicates last packet */
|
nkeynes@2 | 119 | port = GETBYTE(2) & 0x03;
|
nkeynes@494 | 120 | mode = GETBYTE(1) & 0x07;
|
nkeynes@2 | 121 | length = GETBYTE(0) & 0xFF;
|
nkeynes@2 | 122 | return_addr = GETWORD(4);
|
nkeynes@447 | 123 |
|
nkeynes@494 | 124 | if( mode == 0x07 ) {
|
nkeynes@494 | 125 | buf += 4;
|
nkeynes@494 | 126 | address +=4; /* skip? */
|
nkeynes@494 | 127 | continue;
|
nkeynes@494 | 128 | }
|
nkeynes@447 | 129 | if( (return_addr & 0x1C000000) != 0x0C000000 ) {
|
nkeynes@447 | 130 | ERROR( "Bad return address in maple packet: %08X", return_addr );
|
nkeynes@447 | 131 | break;
|
nkeynes@2 | 132 | }
|
nkeynes@2 | 133 | return_buf = mem_get_region(return_addr);
|
nkeynes@2 | 134 | cmd = GETBYTE(8);
|
nkeynes@2 | 135 | recv_addr = GETBYTE(9);
|
nkeynes@2 | 136 | send_addr = GETBYTE(10);
|
nkeynes@2 | 137 | /* Sanity checks */
|
nkeynes@2 | 138 | if( GETBYTE(11) != length ||
|
nkeynes@447 | 139 | send_addr >> 6 != port ||
|
nkeynes@2 | 140 | recv_addr >> 6 != port ||
|
nkeynes@2 | 141 | return_buf == NULL ) {
|
nkeynes@447 | 142 | ERROR( "Received bad packet: %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X %02X",
|
nkeynes@447 | 143 | buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6], buf[7],
|
nkeynes@447 | 144 | buf[8], buf[9], buf[10], buf[11] );
|
nkeynes@447 | 145 | break;
|
nkeynes@2 | 146 | }
|
nkeynes@2 | 147 | periph = 0;
|
nkeynes@2 | 148 | periph_id = recv_addr & 0x3F;
|
nkeynes@2 | 149 | if( periph_id != 0x20 ) {
|
nkeynes@2 | 150 | for( i=0;i<5;i++ ) {
|
nkeynes@2 | 151 | if( periph_id == (1<<i) ) {
|
nkeynes@2 | 152 | periph = i+1;
|
nkeynes@2 | 153 | break;
|
nkeynes@2 | 154 | }
|
nkeynes@2 | 155 | }
|
nkeynes@2 | 156 | if( periph == 0 ) { /* Bad setting */
|
nkeynes@2 | 157 | /* ERROR */
|
nkeynes@2 | 158 | }
|
nkeynes@2 | 159 | }
|
nkeynes@2 | 160 |
|
nkeynes@2 | 161 | maple_device_t dev = maple_devices[port][periph];
|
nkeynes@2 | 162 | if( dev == NULL ) {
|
nkeynes@2 | 163 | /* no device attached */
|
nkeynes@2 | 164 | *((uint32_t *)return_buf) = -1;
|
nkeynes@2 | 165 | } else {
|
nkeynes@2 | 166 | int status, func, block;
|
nkeynes@2 | 167 | out_length = 0;
|
nkeynes@2 | 168 | switch( cmd ) {
|
nkeynes@2 | 169 | case MAPLE_CMD_INFO:
|
nkeynes@2 | 170 | status = MAPLE_RESP_INFO;
|
nkeynes@2 | 171 | memcpy( return_buf+4, dev->ident, 112 );
|
nkeynes@2 | 172 | out_length = 0x1C;
|
nkeynes@2 | 173 | break;
|
nkeynes@2 | 174 | case MAPLE_CMD_EXT_INFO:
|
nkeynes@2 | 175 | status = MAPLE_RESP_EXT_INFO;
|
nkeynes@2 | 176 | memcpy( return_buf+4, dev->ident, 192 );
|
nkeynes@2 | 177 | out_length = 0x30;
|
nkeynes@2 | 178 | break;
|
nkeynes@2 | 179 | case MAPLE_CMD_RESET:
|
nkeynes@2 | 180 | if( dev->reset == NULL )
|
nkeynes@2 | 181 | status = MAPLE_RESP_ACK;
|
nkeynes@2 | 182 | else status = dev->reset(dev);
|
nkeynes@2 | 183 | break;
|
nkeynes@2 | 184 | case MAPLE_CMD_SHUTDOWN:
|
nkeynes@2 | 185 | if( dev->shutdown == NULL )
|
nkeynes@2 | 186 | status = MAPLE_RESP_ACK;
|
nkeynes@2 | 187 | else status = dev->shutdown(dev);
|
nkeynes@2 | 188 | break;
|
nkeynes@2 | 189 | case MAPLE_CMD_GET_COND:
|
nkeynes@2 | 190 | func = GETWORD(12);
|
nkeynes@2 | 191 | if( dev->get_condition == NULL )
|
nkeynes@2 | 192 | status = MAPLE_ERR_CMD_UNKNOWN;
|
nkeynes@2 | 193 | else status = dev->get_condition(dev, func,
|
nkeynes@2 | 194 | return_buf+8,
|
nkeynes@2 | 195 | &out_length );
|
nkeynes@121 | 196 | out_length++;
|
nkeynes@2 | 197 | if( status == 0 ) {
|
nkeynes@2 | 198 | status = MAPLE_RESP_DATA;
|
nkeynes@2 | 199 | PUTWORD(4,func);
|
nkeynes@2 | 200 | }
|
nkeynes@2 | 201 | break;
|
nkeynes@2 | 202 | case MAPLE_CMD_SET_COND:
|
nkeynes@2 | 203 | func = GETWORD(12);
|
nkeynes@2 | 204 | if( dev->set_condition == NULL )
|
nkeynes@2 | 205 | status = MAPLE_ERR_CMD_UNKNOWN;
|
nkeynes@2 | 206 | else status = dev->set_condition(dev, func,
|
nkeynes@2 | 207 | buf+16,
|
nkeynes@2 | 208 | length);
|
nkeynes@2 | 209 | if( status == 0 )
|
nkeynes@2 | 210 | status = MAPLE_RESP_ACK;
|
nkeynes@2 | 211 | break;
|
nkeynes@2 | 212 | case MAPLE_CMD_READ_BLOCK:
|
nkeynes@2 | 213 | func = GETWORD(12);
|
nkeynes@2 | 214 | block = GETWORD(16);
|
nkeynes@2 | 215 | if( dev->read_block == NULL )
|
nkeynes@2 | 216 | status = MAPLE_ERR_CMD_UNKNOWN;
|
nkeynes@2 | 217 | else status = dev->read_block(dev, func, block,
|
nkeynes@2 | 218 | return_buf+12,
|
nkeynes@2 | 219 | &out_length );
|
nkeynes@2 | 220 | if( status == 0 ) {
|
nkeynes@2 | 221 | status = MAPLE_RESP_DATA;
|
nkeynes@2 | 222 | PUTWORD(4,func);
|
nkeynes@2 | 223 | PUTWORD(8,block);
|
nkeynes@2 | 224 | }
|
nkeynes@2 | 225 | break;
|
nkeynes@2 | 226 | case MAPLE_CMD_WRITE_BLOCK:
|
nkeynes@2 | 227 | func = GETWORD(12);
|
nkeynes@2 | 228 | block = GETWORD(16);
|
nkeynes@2 | 229 | if( dev->write_block == NULL )
|
nkeynes@2 | 230 | status = MAPLE_ERR_CMD_UNKNOWN;
|
nkeynes@2 | 231 | else {
|
nkeynes@2 | 232 | status = dev->write_block(dev, func, block,
|
nkeynes@2 | 233 | buf+20, length);
|
nkeynes@2 | 234 | if( status == 0 )
|
nkeynes@2 | 235 | status = MAPLE_RESP_ACK;
|
nkeynes@2 | 236 | }
|
nkeynes@2 | 237 | break;
|
nkeynes@2 | 238 | default:
|
nkeynes@2 | 239 | status = MAPLE_ERR_CMD_UNKNOWN;
|
nkeynes@2 | 240 | }
|
nkeynes@2 | 241 | return_buf[0] = status;
|
nkeynes@2 | 242 | return_buf[1] = send_addr;
|
nkeynes@2 | 243 | return_buf[2] = recv_addr;
|
nkeynes@2 | 244 | if( periph == 0 )
|
nkeynes@2 | 245 | return_buf[2] |= maple_periph_mask[port];
|
nkeynes@2 | 246 | return_buf[3] = out_length;
|
nkeynes@2 | 247 | }
|
nkeynes@2 | 248 | buf += 12 + (length<<2);
|
nkeynes@447 | 249 | address += 12 + (length<<2);
|
nkeynes@2 | 250 | }
|
nkeynes@2 | 251 | asic_event( EVENT_MAPLE_DMA );
|
nkeynes@1 | 252 | }
|
nkeynes@1 | 253 | }
|
nkeynes@2 | 254 |
|
nkeynes@2 | 255 | void maple_attach_device( maple_device_t dev, unsigned int port,
|
nkeynes@2 | 256 | unsigned int periph ) {
|
nkeynes@2 | 257 | assert( port < 4 );
|
nkeynes@2 | 258 | assert( periph < 6 );
|
nkeynes@2 | 259 |
|
nkeynes@2 | 260 | if( maple_devices[port][periph] != NULL ) {
|
nkeynes@2 | 261 | /* Detach existing peripheral first */
|
nkeynes@2 | 262 | maple_detach_device( port, periph );
|
nkeynes@2 | 263 | }
|
nkeynes@2 | 264 |
|
nkeynes@2 | 265 | maple_devices[port][periph] = dev;
|
nkeynes@2 | 266 | if( periph != 0 )
|
nkeynes@2 | 267 | maple_periph_mask[port] |= (1<<(periph-1));
|
nkeynes@2 | 268 | else maple_periph_mask[port] |= 0x20;
|
nkeynes@2 | 269 | if( dev->attach != NULL ) {
|
nkeynes@2 | 270 | dev->attach( dev );
|
nkeynes@2 | 271 | }
|
nkeynes@2 | 272 | }
|
nkeynes@2 | 273 |
|
nkeynes@2 | 274 | void maple_detach_device( unsigned int port, unsigned int periph ) {
|
nkeynes@2 | 275 | assert( port < 4 );
|
nkeynes@2 | 276 | assert( periph < 6 );
|
nkeynes@2 | 277 |
|
nkeynes@2 | 278 | maple_device_t dev = maple_devices[port][periph];
|
nkeynes@2 | 279 | if( dev == NULL ) /* already detached */
|
nkeynes@2 | 280 | return;
|
nkeynes@2 | 281 | maple_devices[port][periph] = NULL;
|
nkeynes@2 | 282 | if( dev->detach != NULL ) {
|
nkeynes@2 | 283 | dev->detach(dev);
|
nkeynes@2 | 284 | }
|
nkeynes@447 | 285 | if( dev->destroy != NULL ) {
|
nkeynes@447 | 286 | dev->destroy(dev);
|
nkeynes@447 | 287 | }
|
nkeynes@2 | 288 | if( periph == 0 ) {
|
nkeynes@2 | 289 | /* If we detach the main peripheral, we also have to detach all the
|
nkeynes@2 | 290 | * subperipherals, or the system could get quite confused
|
nkeynes@2 | 291 | */
|
nkeynes@2 | 292 | int i;
|
nkeynes@2 | 293 | maple_periph_mask[port] = 0;
|
nkeynes@2 | 294 | for( i=1; i<6; i++ ) {
|
nkeynes@2 | 295 | maple_detach_device(port,i);
|
nkeynes@2 | 296 | }
|
nkeynes@2 | 297 | } else {
|
nkeynes@2 | 298 | maple_periph_mask[port] &= (~(1<<(periph-1)));
|
nkeynes@2 | 299 | }
|
nkeynes@144 | 300 |
|
nkeynes@2 | 301 | }
|
nkeynes@144 | 302 |
|
nkeynes@144 | 303 | void maple_detach_all() {
|
nkeynes@144 | 304 | int i, j;
|
nkeynes@144 | 305 | for( i=0; i<4; i++ ) {
|
nkeynes@144 | 306 | for( j=0; j<6; j++ ) {
|
nkeynes@144 | 307 | if( maple_devices[i][j] != NULL ) {
|
nkeynes@144 | 308 | maple_device_t dev = maple_devices[i][j];
|
nkeynes@144 | 309 | if( dev->detach != NULL )
|
nkeynes@144 | 310 | dev->detach(dev);
|
nkeynes@144 | 311 | if( dev->destroy != NULL )
|
nkeynes@144 | 312 | dev->destroy(dev);
|
nkeynes@144 | 313 | }
|
nkeynes@144 | 314 | }
|
nkeynes@144 | 315 | maple_periph_mask[i] = 0;
|
nkeynes@144 | 316 | }
|
nkeynes@144 | 317 | }
|
nkeynes@144 | 318 |
|
nkeynes@144 | 319 | void maple_reattach_all() {
|
nkeynes@144 | 320 | int i, j;
|
nkeynes@144 | 321 | for( i=0; i<4; i++ ) {
|
nkeynes@144 | 322 | for( j=0; j<6; j++ ) {
|
nkeynes@144 | 323 | if( maple_devices[i][j] != NULL ) {
|
nkeynes@144 | 324 | maple_device_t dev = maple_devices[i][j];
|
nkeynes@144 | 325 | if( dev->attach != NULL )
|
nkeynes@144 | 326 | dev->attach(dev);
|
nkeynes@144 | 327 | }
|
nkeynes@144 | 328 | }
|
nkeynes@144 | 329 | }
|
nkeynes@144 | 330 | }
|