src/mess/machine/amigafdc.c
| r6731 | r6732 | |
| 13 | 13 | |
| 14 | 14 | #include "driver.h" |
| 15 | 15 | #include "includes/amiga.h" |
| 16 | #include "devices/flopdrv.h" |
| 17 | #include "formats/ami_dsk.h" |
| 16 | 18 | #include "amigafdc.h" |
| 17 | 19 | #include "machine/6526cia.h" |
| 18 | 20 | |
| r6731 | r6732 | |
| 30 | 32 | #define NUM_DRIVES 2 |
| 31 | 33 | |
| 32 | 34 | /* required prototype */ |
| 33 | | static void setup_fdc_buffer( int drive ); |
| 35 | static void setup_fdc_buffer( const device_config *device,int drive ); |
| 34 | 36 | |
| 37 | /*************************************************************************** |
| 38 | TYPE DEFINITIONS |
| 39 | ***************************************************************************/ |
| 35 | 40 | typedef struct { |
| 36 | 41 | int motor_on; |
| 37 | 42 | int side; |
| r6731 | r6732 | |
| 55 | 60 | offs_t ptr; |
| 56 | 61 | } fdc_def; |
| 57 | 62 | |
| 58 | | static fdc_def fdc_status[NUM_DRIVES]; |
| 59 | | /* signals */ |
| 60 | | static int fdc_sel = 0x0f; |
| 61 | | static int fdc_dir = 0; |
| 62 | | static int fdc_side = 1; |
| 63 | | static int fdc_step = 1; |
| 64 | | static int fdc_rdy = 0; |
| 63 | typedef struct _amiga_fdc_t amiga_fdc_t; |
| 64 | struct _amiga_fdc_t |
| 65 | { |
| 66 | fdc_def fdc_status[NUM_DRIVES]; |
| 67 | |
| 68 | /* signals */ |
| 69 | int fdc_sel; |
| 70 | int fdc_dir; |
| 71 | int fdc_side; |
| 72 | int fdc_step; |
| 73 | int fdc_rdy; |
| 74 | }; |
| 65 | 75 | |
| 76 | /***************************************************************************** |
| 77 | INLINE FUNCTIONS |
| 78 | *****************************************************************************/ |
| 79 | INLINE amiga_fdc_t *get_safe_token(const device_config *device) |
| 80 | { |
| 81 | assert(device != NULL); |
| 82 | assert(device->token != NULL); |
| 83 | |
| 84 | return (amiga_fdc_t *)device->token; |
| 85 | } |
| 86 | |
| 66 | 87 | static TIMER_CALLBACK(fdc_rev_proc); |
| 67 | 88 | static TIMER_CALLBACK(fdc_dma_proc); |
| 68 | 89 | static TIMER_CALLBACK(fdc_sync_proc); |
| 90 | static void check_extended_image( const device_config *device, int id ); |
| 69 | 91 | |
| 92 | static void amiga_load_proc(const device_config *image) |
| 93 | { |
| 94 | amiga_fdc_t *fdc = get_safe_token(image->owner); |
| 95 | int id = floppy_get_drive(image); |
| 96 | fdc->fdc_status[id].disk_changed = DISK_DETECT_DELAY; |
| 97 | fdc->fdc_status[id].f = image; |
| 98 | fdc->fdc_status[id].cached = -1; |
| 99 | fdc->fdc_status[id].motor_on = 0; |
| 100 | fdc->fdc_status[id].rev_timer_started = 0; |
| 101 | timer_reset( fdc->fdc_status[id].rev_timer, attotime_never ); |
| 102 | timer_reset( fdc->fdc_status[id].sync_timer, attotime_never ); |
| 103 | timer_reset( fdc->fdc_status[id].dma_timer, attotime_never ); |
| 104 | fdc->fdc_rdy = 0; |
| 105 | |
| 106 | check_extended_image( image->owner, id ); |
| 107 | } |
| 108 | |
| 109 | static void amiga_unload_proc(const device_config *image) |
| 110 | { |
| 111 | amiga_fdc_t *fdc = get_safe_token(image->owner); |
| 112 | int id = floppy_get_drive(image); |
| 113 | fdc->fdc_status[id].disk_changed = DISK_DETECT_DELAY; |
| 114 | fdc->fdc_status[id].f = NULL; |
| 115 | fdc->fdc_status[id].cached = -1; |
| 116 | fdc->fdc_status[id].motor_on = 0; |
| 117 | fdc->fdc_status[id].rev_timer_started = 0; |
| 118 | timer_reset( fdc->fdc_status[id].rev_timer, attotime_never ); |
| 119 | timer_reset( fdc->fdc_status[id].sync_timer, attotime_never ); |
| 120 | timer_reset( fdc->fdc_status[id].dma_timer, attotime_never ); |
| 121 | fdc->fdc_rdy = 0; |
| 122 | } |
| 123 | |
| 124 | /*------------------------------------------------- |
| 125 | DEVICE_START(amiga_fdc) |
| 126 | -------------------------------------------------*/ |
| 127 | const device_config *amiga_floppy_get_device_child(const device_config *device,int drive) |
| 128 | { |
| 129 | switch(drive) { |
| 130 | case 0 : return device_find_child_by_tag(device,FLOPPY_0); |
| 131 | case 1 : return device_find_child_by_tag(device,FLOPPY_1); |
| 132 | } |
| 133 | return NULL; |
| 134 | } |
| 135 | |
| 70 | 136 | static DEVICE_START(amiga_fdc) |
| 71 | 137 | { |
| 72 | | int id = image_index_in_device(device); |
| 73 | | fdc_status[id].motor_on = 0; |
| 74 | | fdc_status[id].side = 0; |
| 75 | | fdc_status[id].dir = 0; |
| 76 | | fdc_status[id].wprot = 1; |
| 77 | | fdc_status[id].cyl = 0; |
| 78 | | fdc_status[id].rev_timer = timer_alloc(device->machine, fdc_rev_proc, NULL); |
| 79 | | fdc_status[id].dma_timer = timer_alloc(device->machine, fdc_dma_proc, NULL); |
| 80 | | fdc_status[id].sync_timer = timer_alloc(device->machine, fdc_sync_proc, NULL); |
| 81 | | fdc_status[id].rev_timer_started = 0; |
| 82 | | fdc_status[id].cached = -1; |
| 83 | | fdc_status[id].pos = 0; |
| 84 | | fdc_status[id].len = 0; |
| 85 | | fdc_status[id].ptr = 0; |
| 86 | | fdc_status[id].f = NULL; |
| 87 | | fdc_status[id].is_ext_image = 0; |
| 88 | | fdc_status[id].tracklen = MAX_TRACK_BYTES; |
| 89 | | fdc_status[id].disk_changed = DISK_DETECT_DELAY; |
| 138 | amiga_fdc_t *fdc = get_safe_token(device); |
| 139 | int id; |
| 140 | for(id=0;id<2;id++) |
| 141 | { |
| 142 | fdc->fdc_status[id].rev_timer = timer_alloc(device->machine, fdc_rev_proc, (void*)device); |
| 143 | fdc->fdc_status[id].dma_timer = timer_alloc(device->machine, fdc_dma_proc, (void*)device); |
| 144 | fdc->fdc_status[id].sync_timer = timer_alloc(device->machine, fdc_sync_proc, (void*)device); |
| 145 | floppy_install_load_proc(amiga_floppy_get_device_child(device, id), amiga_load_proc); |
| 146 | floppy_install_unload_proc(amiga_floppy_get_device_child(device, id), amiga_unload_proc); |
| 147 | fdc->fdc_status[id].motor_on = 0; |
| 148 | fdc->fdc_status[id].side = 0; |
| 149 | fdc->fdc_status[id].dir = 0; |
| 150 | fdc->fdc_status[id].wprot = 1; |
| 151 | fdc->fdc_status[id].cyl = 0; |
| 152 | fdc->fdc_status[id].rev_timer_started = 0; |
| 153 | fdc->fdc_status[id].cached = -1; |
| 154 | fdc->fdc_status[id].pos = 0; |
| 155 | fdc->fdc_status[id].len = 0; |
| 156 | fdc->fdc_status[id].ptr = 0; |
| 157 | fdc->fdc_status[id].f = NULL; |
| 158 | fdc->fdc_status[id].is_ext_image = 0; |
| 159 | fdc->fdc_status[id].tracklen = MAX_TRACK_BYTES; |
| 160 | fdc->fdc_status[id].disk_changed = DISK_DETECT_DELAY; |
| 161 | timer_reset( fdc->fdc_status[id].rev_timer, attotime_never ); |
| 162 | timer_reset( fdc->fdc_status[id].sync_timer, attotime_never ); |
| 163 | timer_reset( fdc->fdc_status[id].dma_timer, attotime_never ); |
| 164 | memset( fdc->fdc_status[id].mfm, 0xaa, MAX_MFM_TRACK_LEN ); |
| 165 | } |
| 166 | fdc->fdc_sel = 0x0f; |
| 167 | fdc->fdc_dir = 0; |
| 168 | fdc->fdc_side = 1; |
| 169 | fdc->fdc_step = 1; |
| 170 | fdc->fdc_rdy = 0; |
| 171 | |
| 172 | } |
| 90 | 173 | |
| 91 | | memset( fdc_status[id].mfm, 0xaa, MAX_MFM_TRACK_LEN ); |
| 92 | 174 | |
| 93 | | fdc_sel = 0x0f; |
| 94 | | fdc_dir = 0; |
| 95 | | fdc_side = 1; |
| 96 | | fdc_step = 1; |
| 97 | | fdc_rdy = 0; |
| 175 | /*------------------------------------------------- |
| 176 | DEVICE_RESET(amiga_fdc) |
| 177 | -------------------------------------------------*/ |
| 178 | |
| 179 | static DEVICE_RESET(amiga_fdc) |
| 180 | { |
| 98 | 181 | } |
| 99 | 182 | |
| 100 | | static void check_extended_image( int id ) |
| 183 | static void check_extended_image( const device_config *device, int id ) |
| 101 | 184 | { |
| 102 | 185 | UINT8 header[8], data[4]; |
| 186 | amiga_fdc_t *fdc = get_safe_token(device); |
| 187 | |
| 188 | fdc->fdc_status[id].is_ext_image = 0; |
| 103 | 189 | |
| 104 | | fdc_status[id].is_ext_image = 0; |
| 105 | | |
| 106 | | if ( image_fseek( fdc_status[id].f, 0, SEEK_SET ) ) |
| 190 | if ( image_fseek( fdc->fdc_status[id].f, 0, SEEK_SET ) ) |
| 107 | 191 | { |
| 108 | 192 | logerror("FDC: image_fseek failed!\n" ); |
| 109 | 193 | return; |
| 110 | 194 | } |
| 111 | 195 | |
| 112 | | image_fread( fdc_status[id].f, &header, sizeof( header ) ); |
| 196 | image_fread( fdc->fdc_status[id].f, &header, sizeof( header ) ); |
| 113 | 197 | |
| 114 | 198 | if ( memcmp( header, "UAE--ADF", sizeof( header ) ) == 0 ) |
| 115 | 199 | { |
| r6731 | r6732 | |
| 117 | 201 | |
| 118 | 202 | for( i = 0; i < MAX_TRACKS; i++ ) |
| 119 | 203 | { |
| 120 | | image_fread( fdc_status[id].f, &data, sizeof( data ) ); |
| 204 | image_fread( fdc->fdc_status[id].f, &data, sizeof( data ) ); |
| 121 | 205 | |
| 122 | 206 | /* data[0,1] = SYNC - data[2,3] = LEN */ |
| 123 | 207 | |
| 124 | | fdc_status[id].extinfo[i] = data[0]; |
| 125 | | fdc_status[id].extinfo[i] <<= 8; |
| 126 | | fdc_status[id].extinfo[i] |= data[1]; |
| 127 | | fdc_status[id].extinfo[i] <<= 8; |
| 128 | | fdc_status[id].extinfo[i] |= data[2]; |
| 129 | | fdc_status[id].extinfo[i] <<= 8; |
| 130 | | fdc_status[id].extinfo[i] |= data[3]; |
| 208 | fdc->fdc_status[id].extinfo[i] = data[0]; |
| 209 | fdc->fdc_status[id].extinfo[i] <<= 8; |
| 210 | fdc->fdc_status[id].extinfo[i] |= data[1]; |
| 211 | fdc->fdc_status[id].extinfo[i] <<= 8; |
| 212 | fdc->fdc_status[id].extinfo[i] |= data[2]; |
| 213 | fdc->fdc_status[id].extinfo[i] <<= 8; |
| 214 | fdc->fdc_status[id].extinfo[i] |= data[3]; |
| 131 | 215 | |
| 132 | 216 | if ( i == 0 ) |
| 133 | | fdc_status[id].extoffs[i] = sizeof( header ) + ( MAX_TRACKS * sizeof( data ) ); |
| 217 | fdc->fdc_status[id].extoffs[i] = sizeof( header ) + ( MAX_TRACKS * sizeof( data ) ); |
| 134 | 218 | else |
| 135 | | fdc_status[id].extoffs[i] = fdc_status[id].extoffs[i-1] + ( fdc_status[id].extinfo[i-1] & 0xffff ); |
| 219 | fdc->fdc_status[id].extoffs[i] = fdc->fdc_status[id].extoffs[i-1] + ( fdc->fdc_status[id].extinfo[i-1] & 0xffff ); |
| 136 | 220 | } |
| 137 | 221 | |
| 138 | | fdc_status[id].is_ext_image = 1; |
| 222 | fdc->fdc_status[id].is_ext_image = 1; |
| 139 | 223 | } |
| 140 | 224 | } |
| 141 | 225 | |
| 142 | | static DEVICE_IMAGE_LOAD(amiga_fdc) |
| 226 | static int fdc_get_curpos( const device_config *device, int drive ) |
| 143 | 227 | { |
| 144 | | int id = image_index_in_device(image); |
| 145 | | |
| 146 | | fdc_status[id].disk_changed = DISK_DETECT_DELAY; |
| 147 | | fdc_status[id].f = image; |
| 148 | | fdc_status[id].cached = -1; |
| 149 | | fdc_status[id].motor_on = 0; |
| 150 | | fdc_status[id].rev_timer_started = 0; |
| 151 | | timer_reset( fdc_status[id].rev_timer, attotime_never ); |
| 152 | | timer_reset( fdc_status[id].sync_timer, attotime_never ); |
| 153 | | timer_reset( fdc_status[id].dma_timer, attotime_never ); |
| 154 | | fdc_rdy = 0; |
| 155 | | |
| 156 | | check_extended_image( id ); |
| 157 | | |
| 158 | | return INIT_PASS; |
| 159 | | } |
| 160 | | |
| 161 | | static DEVICE_IMAGE_UNLOAD(amiga_fdc) |
| 162 | | { |
| 163 | | int id = image_index_in_device(image); |
| 164 | | |
| 165 | | fdc_status[id].disk_changed = DISK_DETECT_DELAY; |
| 166 | | fdc_status[id].f = NULL; |
| 167 | | fdc_status[id].cached = -1; |
| 168 | | fdc_status[id].motor_on = 0; |
| 169 | | fdc_status[id].rev_timer_started = 0; |
| 170 | | timer_reset( fdc_status[id].rev_timer, attotime_never ); |
| 171 | | timer_reset( fdc_status[id].sync_timer, attotime_never ); |
| 172 | | timer_reset( fdc_status[id].dma_timer, attotime_never ); |
| 173 | | fdc_rdy = 0; |
| 174 | | } |
| 175 | | |
| 176 | | static int fdc_get_curpos( int drive ) |
| 177 | | { |
| 178 | 228 | double elapsed; |
| 179 | 229 | int speed; |
| 180 | 230 | int bytes; |
| 181 | 231 | int pos; |
| 232 | amiga_fdc_t *fdc = get_safe_token(device); |
| 182 | 233 | |
| 183 | | if ( fdc_status[drive].rev_timer_started == 0 ) { |
| 234 | if ( fdc->fdc_status[drive].rev_timer_started == 0 ) { |
| 184 | 235 | logerror("Rev timer not started on drive %d, cant get position!\n", drive ); |
| 185 | 236 | return 0; |
| 186 | 237 | } |
| 187 | 238 | |
| 188 | | elapsed = attotime_to_double(timer_timeelapsed( fdc_status[drive].rev_timer )); |
| 239 | elapsed = attotime_to_double(timer_timeelapsed( fdc->fdc_status[drive].rev_timer )); |
| 189 | 240 | speed = ( CUSTOM_REG(REG_ADKCON) & 0x100 ) ? 2 : 4; |
| 190 | 241 | |
| 191 | 242 | bytes = elapsed / attotime_to_double( ATTOTIME_IN_USEC( speed * 8 ) ); |
| 192 | | pos = bytes % ( fdc_status[drive].tracklen ); |
| 243 | pos = bytes % ( fdc->fdc_status[drive].tracklen ); |
| 193 | 244 | |
| 194 | 245 | return pos; |
| 195 | 246 | } |
| 196 | 247 | |
| 197 | | UINT16 amiga_fdc_get_byte( void ) { |
| 248 | UINT16 amiga_fdc_get_byte (const device_config *device) |
| 249 | { |
| 198 | 250 | int pos; |
| 199 | 251 | int i, drive = -1; |
| 200 | 252 | UINT16 ret; |
| 253 | amiga_fdc_t *fdc = get_safe_token(device); |
| 201 | 254 | |
| 202 | 255 | ret = ( ( CUSTOM_REG(REG_DSKLEN) >> 1 ) & 0x4000 ) & ( ( CUSTOM_REG(REG_DMACON) << 10 ) & 0x4000 ); |
| 203 | 256 | ret |= ( CUSTOM_REG(REG_DSKLEN) >> 1 ) & 0x2000; |
| 204 | 257 | |
| 205 | 258 | for ( i = 0; i < NUM_DRIVES; i++ ) { |
| 206 | | if ( !( fdc_sel & ( 1 << i ) ) ) |
| 259 | if ( !( fdc->fdc_sel & ( 1 << i ) ) ) |
| 207 | 260 | drive = i; |
| 208 | 261 | } |
| 209 | 262 | |
| 210 | 263 | if ( drive == -1 ) |
| 211 | 264 | return ret; |
| 212 | 265 | |
| 213 | | if ( fdc_status[drive].disk_changed ) |
| 266 | if ( fdc->fdc_status[drive].disk_changed ) |
| 214 | 267 | return ret; |
| 215 | 268 | |
| 216 | | setup_fdc_buffer( drive ); |
| 269 | setup_fdc_buffer( device,drive ); |
| 217 | 270 | |
| 218 | | pos = fdc_get_curpos( drive ); |
| 271 | pos = fdc_get_curpos( device, drive ); |
| 219 | 272 | |
| 220 | | if ( fdc_status[drive].mfm[pos] == ( CUSTOM_REG(REG_DSRSYNC) >> 8 ) && |
| 221 | | fdc_status[drive].mfm[pos+1] == ( CUSTOM_REG(REG_DSRSYNC) & 0xff ) ) |
| 273 | if ( fdc->fdc_status[drive].mfm[pos] == ( CUSTOM_REG(REG_DSRSYNC) >> 8 ) && |
| 274 | fdc->fdc_status[drive].mfm[pos+1] == ( CUSTOM_REG(REG_DSRSYNC) & 0xff ) ) |
| 222 | 275 | ret |= 0x1000; |
| 223 | 276 | |
| 224 | | if ( pos != fdc_status[drive].pos ) { |
| 277 | if ( pos != fdc->fdc_status[drive].pos ) { |
| 225 | 278 | ret |= 0x8000; |
| 226 | | fdc_status[drive].pos = pos; |
| 279 | fdc->fdc_status[drive].pos = pos; |
| 227 | 280 | } |
| 228 | 281 | |
| 229 | | ret |= fdc_status[drive].mfm[pos]; |
| 282 | ret |= fdc->fdc_status[drive].mfm[pos]; |
| 230 | 283 | |
| 231 | 284 | return ret; |
| 232 | 285 | } |
| r6731 | r6732 | |
| 238 | 291 | int cur_pos; |
| 239 | 292 | int sector; |
| 240 | 293 | int time; |
| 294 | amiga_fdc_t *fdc = get_safe_token(ptr); |
| 241 | 295 | |
| 242 | 296 | /* if floppy got ejected, stop */ |
| 243 | | if ( fdc_status[drive].disk_changed ) |
| 297 | if ( fdc->fdc_status[drive].disk_changed ) |
| 244 | 298 | goto bail; |
| 245 | 299 | |
| 246 | | if ( fdc_status[drive].motor_on == 0 ) |
| 300 | if ( fdc->fdc_status[drive].motor_on == 0 ) |
| 247 | 301 | goto bail; |
| 248 | 302 | |
| 249 | | cur_pos = fdc_get_curpos( drive ); |
| 303 | cur_pos = fdc_get_curpos( ptr, drive ); |
| 250 | 304 | |
| 251 | 305 | if ( cur_pos <= ( GAP_TRACK_BYTES + 6 ) ) |
| 252 | 306 | { |
| r6731 | r6732 | |
| 257 | 311 | sector = ( cur_pos - ( GAP_TRACK_BYTES + 6 ) ) / ONE_SECTOR_BYTES; |
| 258 | 312 | } |
| 259 | 313 | |
| 260 | | setup_fdc_buffer( drive ); |
| 314 | setup_fdc_buffer( ptr, drive ); |
| 261 | 315 | |
| 262 | 316 | if ( cur_pos < 2 ) |
| 263 | 317 | cur_pos = 2; |
| 264 | 318 | |
| 265 | | if ( fdc_status[drive].mfm[cur_pos-2] == ( ( sync >> 8 ) & 0xff ) && |
| 266 | | fdc_status[drive].mfm[cur_pos-1] == ( sync & 0xff ) ) |
| 319 | if ( fdc->fdc_status[drive].mfm[cur_pos-2] == ( ( sync >> 8 ) & 0xff ) && |
| 320 | fdc->fdc_status[drive].mfm[cur_pos-1] == ( sync & 0xff ) ) |
| 267 | 321 | { |
| 268 | 322 | const address_space *space = cputag_get_address_space(machine, "maincpu", ADDRESS_SPACE_PROGRAM); |
| 269 | 323 | |
| r6731 | r6732 | |
| 276 | 330 | time = ONE_SECTOR_BYTES; |
| 277 | 331 | time *= ( CUSTOM_REG(REG_ADKCON) & 0x0100 ) ? 2 : 4; |
| 278 | 332 | time *= 8; |
| 279 | | timer_adjust_oneshot(fdc_status[drive].sync_timer, ATTOTIME_IN_USEC( time ), drive); |
| 333 | timer_adjust_oneshot(fdc->fdc_status[drive].sync_timer, ATTOTIME_IN_USEC( time ), drive); |
| 280 | 334 | return; |
| 281 | 335 | } |
| 282 | 336 | |
| 283 | 337 | bail: |
| 284 | | timer_reset( fdc_status[drive].sync_timer, attotime_never ); |
| 338 | timer_reset( fdc->fdc_status[drive].sync_timer, attotime_never ); |
| 285 | 339 | } |
| 286 | 340 | |
| 287 | 341 | static TIMER_CALLBACK(fdc_dma_proc) |
| 288 | 342 | { |
| 289 | 343 | int drive = param; |
| 344 | amiga_fdc_t *fdc = get_safe_token(ptr); |
| 345 | |
| 290 | 346 | /* if DMA got disabled by the time we got here, stop operations */ |
| 291 | 347 | if ( ( CUSTOM_REG(REG_DSKLEN) & 0x8000 ) == 0 ) |
| 292 | 348 | goto bail; |
| r6731 | r6732 | |
| 295 | 351 | goto bail; |
| 296 | 352 | |
| 297 | 353 | /* if floppy got ejected, also stop */ |
| 298 | | if ( fdc_status[drive].disk_changed ) |
| 354 | if ( fdc->fdc_status[drive].disk_changed ) |
| 299 | 355 | goto bail; |
| 300 | 356 | |
| 301 | | if ( fdc_status[drive].motor_on == 0 ) |
| 357 | if ( fdc->fdc_status[drive].motor_on == 0 ) |
| 302 | 358 | goto bail; |
| 303 | 359 | |
| 304 | | setup_fdc_buffer( drive ); |
| 360 | setup_fdc_buffer( ptr, drive ); |
| 305 | 361 | |
| 306 | 362 | if ( CUSTOM_REG(REG_DSKLEN) & 0x4000 ) /* disk write case, unsupported yet */ |
| 307 | 363 | { |
| 308 | | if ( fdc_status[drive].len > 0 ) |
| 364 | if ( fdc->fdc_status[drive].len > 0 ) |
| 309 | 365 | { |
| 310 | 366 | const address_space *space = cputag_get_address_space(machine, "maincpu", ADDRESS_SPACE_PROGRAM); |
| 311 | 367 | |
| r6731 | r6732 | |
| 316 | 372 | } |
| 317 | 373 | else |
| 318 | 374 | { |
| 319 | | offs_t offset = fdc_status[drive].ptr; |
| 320 | | int cur_pos = fdc_status[drive].pos; |
| 321 | | int len = fdc_status[drive].len; |
| 375 | offs_t offset = fdc->fdc_status[drive].ptr; |
| 376 | int cur_pos = fdc->fdc_status[drive].pos; |
| 377 | int len = fdc->fdc_status[drive].len; |
| 322 | 378 | |
| 323 | 379 | if ( len > MAX_WORDS_PER_DMA_CYCLE ) len = MAX_WORDS_PER_DMA_CYCLE; |
| 324 | 380 | |
| 325 | | fdc_status[drive].len -= len; |
| 381 | fdc->fdc_status[drive].len -= len; |
| 326 | 382 | |
| 327 | 383 | while ( len-- ) |
| 328 | 384 | { |
| 329 | | int dat = ( fdc_status[drive].mfm[cur_pos++] ) << 8; |
| 385 | int dat = ( fdc->fdc_status[drive].mfm[cur_pos++] ) << 8; |
| 330 | 386 | |
| 331 | | cur_pos %= ( fdc_status[drive].tracklen ); |
| 387 | cur_pos %= ( fdc->fdc_status[drive].tracklen ); |
| 332 | 388 | |
| 333 | | dat |= fdc_status[drive].mfm[cur_pos++]; |
| 389 | dat |= fdc->fdc_status[drive].mfm[cur_pos++]; |
| 334 | 390 | |
| 335 | | cur_pos %= ( fdc_status[drive].tracklen ); |
| 391 | cur_pos %= ( fdc->fdc_status[drive].tracklen ); |
| 336 | 392 | |
| 337 | 393 | amiga_chip_ram_w(offset, dat); |
| 338 | 394 | |
| 339 | 395 | offset += 2; |
| 340 | 396 | } |
| 341 | 397 | |
| 342 | | fdc_status[drive].ptr = offset; |
| 343 | | fdc_status[drive].pos = cur_pos; |
| 398 | fdc->fdc_status[drive].ptr = offset; |
| 399 | fdc->fdc_status[drive].pos = cur_pos; |
| 344 | 400 | |
| 345 | | if ( fdc_status[drive].len <= 0 ) |
| 401 | if ( fdc->fdc_status[drive].len <= 0 ) |
| 346 | 402 | { |
| 347 | 403 | const address_space *space = cputag_get_address_space(machine, "maincpu", ADDRESS_SPACE_PROGRAM); |
| 348 | 404 | |
| r6731 | r6732 | |
| 351 | 407 | else |
| 352 | 408 | { |
| 353 | 409 | int time; |
| 354 | | double len_words = fdc_status[drive].len; |
| 410 | double len_words = fdc->fdc_status[drive].len; |
| 355 | 411 | if ( len_words > MAX_WORDS_PER_DMA_CYCLE ) len_words = MAX_WORDS_PER_DMA_CYCLE; |
| 356 | 412 | |
| 357 | 413 | time = len_words * 2; |
| 358 | 414 | time *= ( CUSTOM_REG(REG_ADKCON) & 0x0100 ) ? 2 : 4; |
| 359 | 415 | time *= 8; |
| 360 | | timer_adjust_oneshot(fdc_status[drive].dma_timer, ATTOTIME_IN_USEC( time ), drive); |
| 416 | timer_adjust_oneshot(fdc->fdc_status[drive].dma_timer, ATTOTIME_IN_USEC( time ), drive); |
| 361 | 417 | return; |
| 362 | 418 | } |
| 363 | 419 | } |
| 364 | 420 | |
| 365 | 421 | bail: |
| 366 | | timer_reset( fdc_status[drive].dma_timer, attotime_never ); |
| 422 | timer_reset( fdc->fdc_status[drive].dma_timer, attotime_never ); |
| 367 | 423 | } |
| 368 | 424 | |
| 369 | | void amiga_fdc_setup_dma( running_machine *machine ) { |
| 425 | void amiga_fdc_setup_dma( const device_config *device ) { |
| 370 | 426 | int i, cur_pos, drive = -1, len_words = 0; |
| 371 | 427 | int time = 0; |
| 428 | amiga_fdc_t *fdc = get_safe_token(device); |
| 372 | 429 | |
| 373 | 430 | for ( i = 0; i < NUM_DRIVES; i++ ) { |
| 374 | | if ( !( fdc_sel & ( 1 << i ) ) ) |
| 431 | if ( !( fdc->fdc_sel & ( 1 << i ) ) ) |
| 375 | 432 | drive = i; |
| 376 | 433 | } |
| 377 | 434 | |
| 378 | 435 | if ( drive == -1 ) { |
| 379 | | const address_space *space = cputag_get_address_space(machine, "maincpu", ADDRESS_SPACE_PROGRAM); |
| 436 | const address_space *space = cputag_get_address_space(device->machine, "maincpu", ADDRESS_SPACE_PROGRAM); |
| 380 | 437 | |
| 381 | 438 | logerror("Disk DMA started with no drive selected!\n" ); |
| 382 | 439 | amiga_custom_w(space, REG_INTREQ, 0x8000 | INTENA_DSKBLK, 0xffff); |
| r6731 | r6732 | |
| 389 | 446 | if ( ( CUSTOM_REG(REG_DMACON) & 0x0210 ) == 0 ) |
| 390 | 447 | goto bail; |
| 391 | 448 | |
| 392 | | if ( fdc_status[drive].disk_changed ) |
| 449 | if ( fdc->fdc_status[drive].disk_changed ) |
| 393 | 450 | goto bail; |
| 394 | 451 | |
| 395 | | setup_fdc_buffer( drive ); |
| 452 | setup_fdc_buffer( device,drive ); |
| 396 | 453 | |
| 397 | | fdc_status[drive].len = CUSTOM_REG(REG_DSKLEN) & 0x3fff; |
| 398 | | fdc_status[drive].ptr = CUSTOM_REG_LONG(REG_DSKPTH); |
| 399 | | fdc_status[drive].pos = cur_pos = fdc_get_curpos( drive ); |
| 454 | fdc->fdc_status[drive].len = CUSTOM_REG(REG_DSKLEN) & 0x3fff; |
| 455 | fdc->fdc_status[drive].ptr = CUSTOM_REG_LONG(REG_DSKPTH); |
| 456 | fdc->fdc_status[drive].pos = cur_pos = fdc_get_curpos( device, drive ); |
| 400 | 457 | |
| 401 | 458 | /* we'll do a set amount at a time */ |
| 402 | | len_words = fdc_status[drive].len; |
| 459 | len_words = fdc->fdc_status[drive].len; |
| 403 | 460 | if ( len_words > MAX_WORDS_PER_DMA_CYCLE ) len_words = MAX_WORDS_PER_DMA_CYCLE; |
| 404 | 461 | |
| 405 | 462 | if ( CUSTOM_REG(REG_ADKCON) & 0x0400 ) { /* Wait for sync */ |
| r6731 | r6732 | |
| 409 | 466 | |
| 410 | 467 | i = cur_pos; |
| 411 | 468 | do { |
| 412 | | if ( fdc_status[drive].mfm[i] == ( CUSTOM_REG(REG_DSRSYNC) >> 8 ) && |
| 413 | | fdc_status[drive].mfm[i+1] == ( CUSTOM_REG(REG_DSRSYNC) & 0xff ) ) |
| 469 | if ( fdc->fdc_status[drive].mfm[i] == ( CUSTOM_REG(REG_DSRSYNC) >> 8 ) && |
| 470 | fdc->fdc_status[drive].mfm[i+1] == ( CUSTOM_REG(REG_DSRSYNC) & 0xff ) ) |
| 414 | 471 | break; |
| 415 | 472 | |
| 416 | 473 | i++; |
| 417 | | i %= ( fdc_status[drive].tracklen ); |
| 474 | i %= ( fdc->fdc_status[drive].tracklen ); |
| 418 | 475 | time++; |
| 419 | 476 | } while( i != cur_pos ); |
| 420 | 477 | |
| r6731 | r6732 | |
| 422 | 479 | logerror("SYNC not found on track!\n" ); |
| 423 | 480 | return; |
| 424 | 481 | } else { |
| 425 | | fdc_status[drive].pos = i + 2; |
| 482 | fdc->fdc_status[drive].pos = i + 2; |
| 426 | 483 | time += 2; |
| 427 | 484 | } |
| 428 | 485 | } |
| r6731 | r6732 | |
| 430 | 487 | time += len_words * 2; |
| 431 | 488 | time *= ( CUSTOM_REG(REG_ADKCON) & 0x0100 ) ? 2 : 4; |
| 432 | 489 | time *= 8; |
| 433 | | timer_adjust_oneshot(fdc_status[drive].dma_timer, ATTOTIME_IN_USEC( time ), drive); |
| 490 | timer_adjust_oneshot(fdc->fdc_status[drive].dma_timer, ATTOTIME_IN_USEC( time ), drive); |
| 434 | 491 | |
| 435 | 492 | return; |
| 436 | 493 | |
| 437 | 494 | bail: |
| 438 | | timer_reset( fdc_status[drive].dma_timer, attotime_never ); |
| 495 | timer_reset( fdc->fdc_status[drive].dma_timer, attotime_never ); |
| 439 | 496 | } |
| 440 | 497 | |
| 441 | | static void setup_fdc_buffer( int drive ) |
| 498 | static void setup_fdc_buffer( const device_config *device,int drive ) |
| 442 | 499 | { |
| 443 | 500 | int sector, offset, len; |
| 444 | 501 | UINT8 temp_cyl[512*11]; |
| 445 | | |
| 502 | amiga_fdc_t *fdc = get_safe_token(device); |
| 503 | |
| 446 | 504 | /* no disk in drive */ |
| 447 | | if ( fdc_status[drive].f == NULL ) { |
| 448 | | memset( &fdc_status[drive].mfm[0], 0xaa, 32 ); |
| 449 | | fdc_status[drive].disk_changed = DISK_DETECT_DELAY; |
| 505 | if ( fdc->fdc_status[drive].f == NULL ) { |
| 506 | memset( &fdc->fdc_status[drive].mfm[0], 0xaa, 32 ); |
| 507 | fdc->fdc_status[drive].disk_changed = DISK_DETECT_DELAY; |
| 450 | 508 | return; |
| 451 | 509 | } |
| 452 | 510 | |
| 453 | 511 | len = 512*11; |
| 454 | 512 | |
| 455 | | offset = ( fdc_status[drive].cyl << 1 ) | fdc_side; |
| 513 | offset = ( fdc->fdc_status[drive].cyl << 1 ) | fdc->fdc_side; |
| 456 | 514 | |
| 457 | | if ( fdc_status[drive].cached == offset ) |
| 515 | if ( fdc->fdc_status[drive].cached == offset ) |
| 458 | 516 | return; |
| 459 | 517 | |
| 460 | 518 | #if 0 |
| 461 | | popmessage("T:%d S:%d", fdc_status[drive].cyl, fdc_side ); |
| 519 | popmessage("T:%d S:%d", fdc->fdc_status[drive].cyl, fdc_side ); |
| 462 | 520 | #endif |
| 463 | 521 | |
| 464 | | if ( fdc_status[drive].is_ext_image ) |
| 522 | if ( fdc->fdc_status[drive].is_ext_image ) |
| 465 | 523 | { |
| 466 | | len = fdc_status[drive].extinfo[offset] & 0xffff; |
| 524 | len = fdc->fdc_status[drive].extinfo[offset] & 0xffff; |
| 467 | 525 | |
| 468 | 526 | if ( len > ( MAX_MFM_TRACK_LEN - 2 ) ) |
| 469 | 527 | len = MAX_MFM_TRACK_LEN - 2; |
| 470 | 528 | |
| 471 | | if ( image_fseek( fdc_status[drive].f, fdc_status[drive].extoffs[offset], SEEK_SET ) ) |
| 529 | if ( image_fseek( fdc->fdc_status[drive].f, fdc->fdc_status[drive].extoffs[offset], SEEK_SET ) ) |
| 472 | 530 | { |
| 473 | 531 | logerror("FDC: image_fseek failed!\n" ); |
| 474 | | fdc_status[drive].f = NULL; |
| 475 | | fdc_status[drive].disk_changed = DISK_DETECT_DELAY; |
| 532 | fdc->fdc_status[drive].f = NULL; |
| 533 | fdc->fdc_status[drive].disk_changed = DISK_DETECT_DELAY; |
| 476 | 534 | return; |
| 477 | 535 | } |
| 478 | 536 | |
| 479 | 537 | /* if SYNC is 0000, then its a regular amiga dos track image */ |
| 480 | | if ( ( fdc_status[drive].extinfo[offset] >> 16 ) == 0x0000 ) |
| 538 | if ( ( fdc->fdc_status[drive].extinfo[offset] >> 16 ) == 0x0000 ) |
| 481 | 539 | { |
| 482 | | image_fread( fdc_status[drive].f, temp_cyl, len ); |
| 540 | image_fread( fdc->fdc_status[drive].f, temp_cyl, len ); |
| 483 | 541 | /* fall through to regular load */ |
| 484 | 542 | } |
| 485 | 543 | else /* otherwise, it's a raw track */ |
| 486 | 544 | { |
| 487 | | fdc_status[drive].mfm[0] = ( fdc_status[drive].extinfo[offset] >> 24 ) & 0xff; |
| 488 | | fdc_status[drive].mfm[1] = ( fdc_status[drive].extinfo[offset] >> 16 ) & 0xff; |
| 489 | | image_fread( fdc_status[drive].f, &fdc_status[drive].mfm[2], len ); |
| 490 | | fdc_status[drive].tracklen = len + 2; |
| 491 | | fdc_status[drive].cached = offset; |
| 545 | fdc->fdc_status[drive].mfm[0] = ( fdc->fdc_status[drive].extinfo[offset] >> 24 ) & 0xff; |
| 546 | fdc->fdc_status[drive].mfm[1] = ( fdc->fdc_status[drive].extinfo[offset] >> 16 ) & 0xff; |
| 547 | image_fread( fdc->fdc_status[drive].f, &fdc->fdc_status[drive].mfm[2], len ); |
| 548 | fdc->fdc_status[drive].tracklen = len + 2; |
| 549 | fdc->fdc_status[drive].cached = offset; |
| 492 | 550 | return; |
| 493 | 551 | } |
| 494 | 552 | } |
| 495 | 553 | else |
| 496 | 554 | { |
| 497 | | if ( image_fseek( fdc_status[drive].f, offset * len, SEEK_SET ) ) |
| 555 | if ( image_fseek( fdc->fdc_status[drive].f, offset * len, SEEK_SET ) ) |
| 498 | 556 | { |
| 499 | 557 | logerror("FDC: image_fseek failed!\n" ); |
| 500 | | fdc_status[drive].f = NULL; |
| 501 | | fdc_status[drive].disk_changed = DISK_DETECT_DELAY; |
| 558 | fdc->fdc_status[drive].f = NULL; |
| 559 | fdc->fdc_status[drive].disk_changed = DISK_DETECT_DELAY; |
| 502 | 560 | return; |
| 503 | 561 | } |
| 504 | 562 | |
| 505 | | image_fread( fdc_status[drive].f, temp_cyl, len ); |
| 563 | image_fread( fdc->fdc_status[drive].f, temp_cyl, len ); |
| 506 | 564 | } |
| 507 | 565 | |
| 508 | | fdc_status[drive].tracklen = MAX_TRACK_BYTES; |
| 509 | | memset( &fdc_status[drive].mfm[0], 0xaa, GAP_TRACK_BYTES ); |
| 566 | fdc->fdc_status[drive].tracklen = MAX_TRACK_BYTES; |
| 567 | memset( &fdc->fdc_status[drive].mfm[0], 0xaa, GAP_TRACK_BYTES ); |
| 510 | 568 | |
| 511 | 569 | for ( sector = 0; sector < 11; sector++ ) { |
| 512 | 570 | int x; |
| 513 | | UINT8 *dest = ( &fdc_status[drive].mfm[(ONE_SECTOR_BYTES*sector)+GAP_TRACK_BYTES] ); |
| 571 | UINT8 *dest = ( &fdc->fdc_status[drive].mfm[(ONE_SECTOR_BYTES*sector)+GAP_TRACK_BYTES] ); |
| 514 | 572 | UINT8 *src = &temp_cyl[sector*512]; |
| 515 | 573 | UINT32 tmp; |
| 516 | 574 | UINT32 even, odd; |
| r6731 | r6732 | |
| 595 | 653 | *(dest + 63) = (UINT8) (even & 0xff); |
| 596 | 654 | } |
| 597 | 655 | |
| 598 | | fdc_status[drive].cached = offset; |
| 656 | fdc->fdc_status[drive].cached = offset; |
| 599 | 657 | } |
| 600 | 658 | |
| 601 | 659 | static TIMER_CALLBACK(fdc_rev_proc) |
| r6731 | r6732 | |
| 603 | 661 | int drive = param; |
| 604 | 662 | int time; |
| 605 | 663 | const device_config *cia; |
| 664 | amiga_fdc_t *fdc = get_safe_token(ptr); |
| 606 | 665 | |
| 607 | 666 | /* Issue a index pulse when a disk revolution completes */ |
| 608 | 667 | cia = devtag_get_device(machine, "cia_1"); |
| 609 | 668 | cia_issue_index(cia); |
| 610 | 669 | |
| 611 | | timer_adjust_oneshot(fdc_status[drive].rev_timer, ATTOTIME_IN_MSEC( ONE_REV_TIME ), drive); |
| 612 | | fdc_status[drive].rev_timer_started = 1; |
| 670 | timer_adjust_oneshot(fdc->fdc_status[drive].rev_timer, ATTOTIME_IN_MSEC( ONE_REV_TIME ), drive); |
| 671 | fdc->fdc_status[drive].rev_timer_started = 1; |
| 613 | 672 | |
| 614 | | if ( fdc_status[drive].is_ext_image == 0 ) |
| 673 | if ( fdc->fdc_status[drive].is_ext_image == 0 ) |
| 615 | 674 | { |
| 616 | 675 | /* also start the sync timer */ |
| 617 | 676 | time = GAP_TRACK_BYTES + 6; |
| 618 | 677 | time *= ( CUSTOM_REG(REG_ADKCON) & 0x0100 ) ? 2 : 4; |
| 619 | 678 | time *= 8; |
| 620 | | timer_adjust_oneshot(fdc_status[drive].sync_timer, ATTOTIME_IN_USEC( time ), drive); |
| 679 | timer_adjust_oneshot(fdc->fdc_status[drive].sync_timer, ATTOTIME_IN_USEC( time ), drive); |
| 621 | 680 | } |
| 622 | 681 | } |
| 623 | 682 | |
| 624 | | static void start_rev_timer( int drive ) { |
| 683 | static void start_rev_timer( const device_config *device,int drive ) { |
| 625 | 684 | // double time; |
| 626 | | |
| 627 | | if ( fdc_status[drive].rev_timer_started ) { |
| 685 | amiga_fdc_t *fdc = get_safe_token(device); |
| 686 | |
| 687 | if ( fdc->fdc_status[drive].rev_timer_started ) { |
| 628 | 688 | logerror("Revolution timer started twice?!\n" ); |
| 629 | 689 | return; |
| 630 | 690 | } |
| 631 | 691 | |
| 632 | | timer_adjust_oneshot(fdc_status[drive].rev_timer, ATTOTIME_IN_MSEC( ONE_REV_TIME ), drive); |
| 633 | | fdc_status[drive].rev_timer_started = 1; |
| 692 | timer_adjust_oneshot(fdc->fdc_status[drive].rev_timer, ATTOTIME_IN_MSEC( ONE_REV_TIME ), drive); |
| 693 | fdc->fdc_status[drive].rev_timer_started = 1; |
| 634 | 694 | } |
| 635 | 695 | |
| 636 | | static void stop_rev_timer( int drive ) { |
| 637 | | if ( fdc_status[drive].rev_timer_started == 0 ) { |
| 696 | static void stop_rev_timer( const device_config *device,int drive ) { |
| 697 | amiga_fdc_t *fdc = get_safe_token(device); |
| 698 | |
| 699 | if ( fdc->fdc_status[drive].rev_timer_started == 0 ) { |
| 638 | 700 | logerror("Revolution timer never started?!\n" ); |
| 639 | 701 | return; |
| 640 | 702 | } |
| 641 | 703 | |
| 642 | | timer_reset( fdc_status[drive].rev_timer, attotime_never ); |
| 643 | | fdc_status[drive].rev_timer_started = 0; |
| 644 | | timer_reset( fdc_status[drive].dma_timer, attotime_never ); |
| 645 | | timer_reset( fdc_status[drive].sync_timer, attotime_never ); |
| 704 | timer_reset( fdc->fdc_status[drive].rev_timer, attotime_never ); |
| 705 | fdc->fdc_status[drive].rev_timer_started = 0; |
| 706 | timer_reset( fdc->fdc_status[drive].dma_timer, attotime_never ); |
| 707 | timer_reset( fdc->fdc_status[drive].sync_timer, attotime_never ); |
| 646 | 708 | } |
| 647 | 709 | |
| 648 | | static void fdc_setup_leds(running_machine *machine, int drive ) { |
| 710 | static void fdc_setup_leds(const device_config *device, int drive ) { |
| 649 | 711 | |
| 650 | 712 | char portname[12]; |
| 713 | amiga_fdc_t *fdc = get_safe_token(device); |
| 651 | 714 | sprintf(portname, "drive_%d_led", drive); |
| 652 | | output_set_value(portname, fdc_status[drive].motor_on == 0 ? 0 : 1); |
| 715 | output_set_value(portname, fdc->fdc_status[drive].motor_on == 0 ? 0 : 1); |
| 653 | 716 | |
| 654 | 717 | if ( drive == 0 ) |
| 655 | | set_led_status(machine, 1, fdc_status[drive].motor_on ); /* update internal drive led */ |
| 718 | set_led_status(device->machine, 1, fdc->fdc_status[drive].motor_on ); /* update internal drive led */ |
| 656 | 719 | |
| 657 | 720 | if ( drive == 1 ) |
| 658 | | set_led_status(machine, 2, fdc_status[drive].motor_on ); /* update external drive led */ |
| 721 | set_led_status(device->machine, 2, fdc->fdc_status[drive].motor_on ); /* update external drive led */ |
| 659 | 722 | } |
| 660 | 723 | |
| 661 | | static void fdc_stepdrive( int drive ) { |
| 662 | | if ( fdc_dir ) { |
| 663 | | if ( fdc_status[drive].cyl ) |
| 664 | | fdc_status[drive].cyl--; |
| 724 | static void fdc_stepdrive( const device_config *device,int drive ) { |
| 725 | amiga_fdc_t *fdc = get_safe_token(device); |
| 726 | |
| 727 | if ( fdc->fdc_dir ) { |
| 728 | if ( fdc->fdc_status[drive].cyl ) |
| 729 | fdc->fdc_status[drive].cyl--; |
| 665 | 730 | } else { |
| 666 | | if ( fdc_status[drive].cyl < 79 ) |
| 667 | | fdc_status[drive].cyl++; |
| 731 | if ( fdc->fdc_status[drive].cyl < 79 ) |
| 732 | fdc->fdc_status[drive].cyl++; |
| 668 | 733 | } |
| 669 | 734 | |
| 670 | 735 | /* Update disk detection if applicable */ |
| 671 | | if ( fdc_status[drive].f != NULL ) |
| 736 | if ( fdc->fdc_status[drive].f != NULL ) |
| 672 | 737 | { |
| 673 | | if ( fdc_status[drive].disk_changed > 0 ) |
| 674 | | fdc_status[drive].disk_changed--; |
| 738 | if ( fdc->fdc_status[drive].disk_changed > 0 ) |
| 739 | fdc->fdc_status[drive].disk_changed--; |
| 675 | 740 | } |
| 676 | 741 | } |
| 677 | 742 | |
| 678 | | static void fdc_motor( int drive, int off ) { |
| 743 | static void fdc_motor( const device_config *device,int drive, int off ) { |
| 744 | amiga_fdc_t *fdc = get_safe_token(device); |
| 679 | 745 | int on = !off; |
| 680 | 746 | |
| 681 | | if ( ( fdc_status[drive].motor_on == 0 ) && on ) { |
| 682 | | fdc_status[drive].pos = 0; |
| 747 | if ( ( fdc->fdc_status[drive].motor_on == 0 ) && on ) { |
| 748 | fdc->fdc_status[drive].pos = 0; |
| 683 | 749 | |
| 684 | | start_rev_timer( drive ); |
| 750 | start_rev_timer( device,drive ); |
| 685 | 751 | |
| 686 | 752 | } else { |
| 687 | | if ( fdc_status[drive].motor_on && off ) |
| 688 | | stop_rev_timer( drive ); |
| 753 | if ( fdc->fdc_status[drive].motor_on && off ) |
| 754 | stop_rev_timer(device, drive ); |
| 689 | 755 | } |
| 690 | 756 | |
| 691 | | fdc_status[drive].motor_on = on; |
| 757 | fdc->fdc_status[drive].motor_on = on; |
| 692 | 758 | } |
| 693 | 759 | |
| 694 | 760 | WRITE8_DEVICE_HANDLER( amiga_fdc_control_w ) |
| r6731 | r6732 | |
| 696 | 762 | int step_pulse; |
| 697 | 763 | int drive; |
| 698 | 764 | |
| 699 | | if ( fdc_sel != ( ( data >> 3 ) & 15 ) ) |
| 700 | | fdc_rdy = 0; |
| 765 | amiga_fdc_t *fdc = get_safe_token(device); |
| 766 | |
| 767 | if ( fdc->fdc_sel != ( ( data >> 3 ) & 15 ) ) |
| 768 | fdc->fdc_rdy = 0; |
| 701 | 769 | |
| 702 | | fdc_sel = ( data >> 3 ) & 15; |
| 703 | | fdc_side = 1 - ( ( data >> 2 ) & 1 ); |
| 704 | | fdc_dir = ( data >> 1 ) & 1; |
| 770 | fdc->fdc_sel = ( data >> 3 ) & 15; |
| 771 | fdc->fdc_side = 1 - ( ( data >> 2 ) & 1 ); |
| 772 | fdc->fdc_dir = ( data >> 1 ) & 1; |
| 705 | 773 | |
| 706 | 774 | step_pulse = data & 1; |
| 707 | 775 | |
| 708 | | if ( fdc_step != step_pulse ) { |
| 709 | | fdc_step = step_pulse; |
| 776 | if ( fdc->fdc_step != step_pulse ) { |
| 777 | fdc->fdc_step = step_pulse; |
| 710 | 778 | |
| 711 | | if ( fdc_step == 0 ) { |
| 779 | if ( fdc->fdc_step == 0 ) { |
| 712 | 780 | for ( drive = 0; drive < NUM_DRIVES; drive++ ) { |
| 713 | | if ( !( fdc_sel & ( 1 << drive ) ) ) |
| 714 | | fdc_stepdrive( drive ); |
| 781 | if ( !( fdc->fdc_sel & ( 1 << drive ) ) ) |
| 782 | fdc_stepdrive( device, drive ); |
| 715 | 783 | } |
| 716 | 784 | } |
| 717 | 785 | } |
| 718 | 786 | |
| 719 | 787 | for ( drive = 0; drive < NUM_DRIVES; drive++ ) { |
| 720 | | if ( !( fdc_sel & ( 1 << drive ) ) ) { |
| 721 | | fdc_motor( drive, ( data >> 7 ) & 1 ); |
| 722 | | fdc_setup_leds( device->machine,drive ); |
| 788 | if ( !( fdc->fdc_sel & ( 1 << drive ) ) ) { |
| 789 | fdc_motor( device, drive, ( data >> 7 ) & 1 ); |
| 790 | fdc_setup_leds( device,drive ); |
| 723 | 791 | } |
| 724 | 792 | } |
| 725 | 793 | } |
| 726 | 794 | |
| 727 | | int amiga_fdc_status_r( void ) { |
| 795 | UINT8 amiga_fdc_status_r (const device_config *device) |
| 796 | { |
| 728 | 797 | int drive = -1, ret = 0x3c; |
| 729 | | |
| 798 | amiga_fdc_t *fdc = get_safe_token(device); |
| 730 | 799 | for ( drive = 0; drive < NUM_DRIVES; drive++ ) { |
| 731 | | if ( !( fdc_sel & ( 1 << drive ) ) ) { |
| 800 | if ( !( fdc->fdc_sel & ( 1 << drive ) ) ) { |
| 732 | 801 | |
| 733 | | if ( fdc_status[drive].motor_on ) { |
| 734 | | if ( fdc_rdy ) ret &= ~0x20; |
| 735 | | fdc_rdy = 1; |
| 802 | if ( fdc->fdc_status[drive].motor_on ) { |
| 803 | if ( fdc->fdc_rdy ) ret &= ~0x20; |
| 804 | fdc->fdc_rdy = 1; |
| 736 | 805 | } else { |
| 737 | 806 | /* return drive id */ |
| 738 | 807 | ret &= ~0x20; |
| 739 | 808 | } |
| 740 | 809 | |
| 741 | | if ( fdc_status[drive].cyl == 0 ) |
| 810 | if ( fdc->fdc_status[drive].cyl == 0 ) |
| 742 | 811 | ret &= ~0x10; |
| 743 | 812 | |
| 744 | | if ( fdc_status[drive].wprot ) |
| 813 | if ( fdc->fdc_status[drive].wprot ) |
| 745 | 814 | ret &= ~0x08; |
| 746 | 815 | |
| 747 | | if ( fdc_status[drive].disk_changed ) |
| 816 | if ( fdc->fdc_status[drive].disk_changed ) |
| 748 | 817 | ret &= ~0x04; |
| 749 | 818 | |
| 750 | 819 | return ret; |
| r6731 | r6732 | |
| 754 | 823 | return ret; |
| 755 | 824 | } |
| 756 | 825 | |
| 826 | static const floppy_config amiga_floppy_config = |
| 827 | { |
| 828 | DEVCB_NULL, |
| 829 | DEVCB_NULL, |
| 830 | DEVCB_NULL, |
| 831 | DEVCB_NULL, |
| 832 | DEVCB_NULL, |
| 833 | FLOPPY_DRIVE_DS_80, |
| 834 | FLOPPY_OPTIONS_NAME(amiga_only), |
| 835 | DO_NOT_KEEP_GEOMETRY |
| 836 | }; |
| 757 | 837 | |
| 838 | static MACHINE_DRIVER_START( amiga_fdc ) |
| 839 | MDRV_FLOPPY_2_DRIVES_ADD(amiga_floppy_config) |
| 840 | MACHINE_DRIVER_END |
| 758 | 841 | |
| 759 | | void amiga_floppy_getinfo(const mess_device_class *devclass, UINT32 state, union devinfo *info) |
| 842 | |
| 843 | DEVICE_GET_INFO( amiga_fdc ) |
| 760 | 844 | { |
| 761 | | switch(state) |
| 845 | switch (state) |
| 762 | 846 | { |
| 763 | 847 | /* --- the following bits of info are returned as 64-bit signed integers --- */ |
| 764 | | case MESS_DEVINFO_INT_TYPE: info->i = IO_FLOPPY; break; |
| 765 | | case MESS_DEVINFO_INT_COUNT: info->i = NUM_DRIVES; break; |
| 766 | | case MESS_DEVINFO_INT_READABLE: info->i = 1; break; |
| 767 | | case MESS_DEVINFO_INT_WRITEABLE: info->i = 0; break; |
| 768 | | case MESS_DEVINFO_INT_CREATABLE: info->i = 0; break; |
| 848 | case DEVINFO_INT_INLINE_CONFIG_BYTES: info->i = 0; break; |
| 849 | case DEVINFO_INT_TOKEN_BYTES: info->i = sizeof(amiga_fdc_t); break; |
| 850 | case DEVINFO_INT_CLASS: info->i = DEVICE_CLASS_PERIPHERAL; break; |
| 769 | 851 | |
| 852 | /* --- the following bits of info are returned as pointers --- */ |
| 853 | case DEVINFO_PTR_MACHINE_CONFIG: info->machine_config = MACHINE_DRIVER_NAME(amiga_fdc); break; |
| 854 | |
| 770 | 855 | /* --- the following bits of info are returned as pointers to data or functions --- */ |
| 771 | | case MESS_DEVINFO_PTR_START: info->start = DEVICE_START_NAME(amiga_fdc); break; |
| 772 | | case MESS_DEVINFO_PTR_LOAD: info->load = DEVICE_IMAGE_LOAD_NAME(amiga_fdc); break; |
| 773 | | case MESS_DEVINFO_PTR_UNLOAD: info->unload = DEVICE_IMAGE_UNLOAD_NAME(amiga_fdc); break; |
| 856 | case DEVINFO_FCT_START: info->start = DEVICE_START_NAME(amiga_fdc); break; |
| 857 | case DEVINFO_FCT_STOP: /* Nothing */ break; |
| 858 | case DEVINFO_FCT_RESET: info->reset = DEVICE_RESET_NAME(amiga_fdc); break; |
| 774 | 859 | |
| 775 | 860 | /* --- the following bits of info are returned as NULL-terminated strings --- */ |
| 776 | | case MESS_DEVINFO_STR_FILE_EXTENSIONS: strcpy(info->s = device_temp_str(), "adf"); break; |
| 861 | case DEVINFO_STR_NAME: strcpy(info->s, "Amiga FDC"); break; |
| 862 | case DEVINFO_STR_FAMILY: strcpy(info->s, "Amiga FDC"); break; |
| 863 | case DEVINFO_STR_VERSION: strcpy(info->s, "1.0"); break; |
| 864 | case DEVINFO_STR_SOURCE_FILE: strcpy(info->s, __FILE__); break; |
| 865 | case DEVINFO_STR_CREDITS: strcpy(info->s, "Copyright the MESS Team"); break; |
| 777 | 866 | } |
| 778 | 867 | } |
| 868 | |