repos/blastem: cdd_mcu.c annotate

annotate cdd_mcu.c @ 2062:07ed42bd7b4c segacd

Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator

author	Michael Pavone <pavone@retrodev.com>
date	Fri, 28 Jan 2022 00:50:17 -0800
parents	7c1760b5b3e5
children	91e4d2fe5cd9

rev	line source
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	1 #include "cdd_mcu.h"
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	2 #include "backend.h"
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	3
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	4 #define SCD_MCLKS 50000000
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	5 #define CD_BLOCK_CLKS 16934400
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	6 #define CDD_MCU_DIVIDER 8
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	7 #define SECTOR_CLOCKS (CD_BLOCK_CLKS/75)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	8 #define NIBBLE_CLOCKS (CDD_MCU_DIVIDER * 77)
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	9 #define BYTE_CLOCKS (SECTOR_CLOCKS/2352) // 96
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	10
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	11 //lead in start max diameter 46 mm
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	12 //program area start max diameter 50 mm
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	13 //difference 4 mm = 4000 um
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	14 //radius difference 2 mm = 2000 um
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	15 //track pitch 1.6 um
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	16 //1250 physical tracks in between
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	17 //linear speed 1.2 m/s - 1.4 m/s
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	18 // 1.3 m = 1300 mm
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	19 // circumference at 46 mm ~ 144.51 mm
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	20 // circumference at 50 mm ~ 157.08 mm
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	21 // avg is 150.795
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	22 // 75 sectors per second
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	23 // 17.3333 mm "typical" length of a sector
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	24 // ~8.7 sectors per track in lead-in area
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	25 #define LEADIN_SECTORS 10875
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	26
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	27 static uint32_t cd_block_to_mclks(uint32_t cycles)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	28 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	29 return ((uint64_t)cycles) * ((uint64_t)SCD_MCLKS) / ((uint64_t)CD_BLOCK_CLKS);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	30 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	31
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	32 static uint32_t mclks_to_cd_block(uint32_t cycles)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	33 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	34 return ((uint64_t)cycles) * ((uint64_t)CD_BLOCK_CLKS) / ((uint64_t)SCD_MCLKS);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	35 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	36
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	37 void cdd_mcu_init(cdd_mcu context, system_media media)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	38 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	39 context->next_int_cycle = CYCLE_NEVER;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	40 context->last_subcode_cycle = CYCLE_NEVER;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	41 context->last_nibble_cycle = CYCLE_NEVER;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	42 context->requested_format = SF_NOTREADY;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	43 context->media = media;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	44 context->current_status_nibble = -1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	45 context->current_cmd_nibble = -1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	46 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	47
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	48 enum {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	49 GAO_CDD_CTRL,
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	50 GAO_CDD_STATUS,
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	51 GAO_CDD_CMD = GAO_CDD_STATUS+5
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	52 };
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	53
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	54 static uint8_t checksum(uint8_t *vbuffer)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	55 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	56 uint8_t *buffer = vbuffer;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	57 uint8_t sum = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	58 for (int i = 0; i < 9; i++)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	59 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	60 sum += buffer[i];
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	61 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	62 return (~sum) & 0xF;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	63 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	64 #define SEEK_SPEED 2200 //made up number
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	65 static void handle_seek(cdd_mcu *context)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	66 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	67 if (context->seeking) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	68 if (context->seek_pba == context->head_pba) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	69 context->seeking = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	70 } else if (context->seek_pba > context->head_pba) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	71 context->head_pba += SEEK_SPEED;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	72 if (context->head_pba > context->seek_pba) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	73 context->head_pba = context->seek_pba;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	74 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	75 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	76 context->head_pba -= SEEK_SPEED;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	77 if (context->head_pba < context->seek_pba) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	78 context->head_pba = context->seek_pba;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	79 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	80 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	81 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	82 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	83
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	84 static void lba_to_status(cdd_mcu *context, uint32_t lba)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	85 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	86 uint32_t seconds = lba / 75;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	87 uint32_t frames = lba % 75;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	88 uint32_t minutes = seconds / 60;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	89 seconds = seconds % 60;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	90 context->status_buffer.b.time.min_high = minutes / 10;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	91 context->status_buffer.b.time.min_low = minutes % 10;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	92 context->status_buffer.b.time.sec_high = seconds / 10;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	93 context->status_buffer.b.time.sec_low = seconds % 10;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	94 context->status_buffer.b.time.frame_high = frames / 10;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	95 context->status_buffer.b.time.frame_low = frames % 10;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	96 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	97
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	98 static void update_status(cdd_mcu *context)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	99 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	100 switch (context->status)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	101 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	102 case DS_PLAY:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	103 handle_seek(context);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	104 if (!context->seeking) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	105 context->head_pba++;
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	106 uint32_t lba = context->head_pba - LEADIN_SECTORS;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	107 for (uint32_t i = 0; i < context->media->num_tracks; i++)
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	108 {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	109 if (lba < context->media->tracks[i].fake_pregap) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	110 context->in_fake_pregap = 1;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	111 break;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	112 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	113 lba -= context->media->tracks[i].fake_pregap;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	114 if (lba < context->media->tracks[i].start_lba) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	115 context->in_fake_pregap = 1;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	116 break;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	117 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	118 if (lba < context->media->tracks[i].end_lba) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	119 fseek(context->media->f, lba * 2352, SEEK_SET);
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	120 context->in_fake_pregap = 0;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	121 break;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	122 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	123 }
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	124 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	125 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	126 case DS_PAUSE:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	127 handle_seek(context);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	128 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	129 case DS_TOC_READ:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	130 handle_seek(context);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	131 if (!context->seeking) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	132 context->head_pba++;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	133 if (context->media && context->media->type == MEDIA_CDROM && context->media->num_tracks) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	134 if (context->head_pba > 3*context->media->num_tracks + 1) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	135 context->toc_valid = 1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	136 context->seeking = 1;
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	137 context->seek_pba = LEADIN_SECTORS + context->media->tracks[0].start_lba;
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	138 context->status = DS_PAUSE;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	139 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	140
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	141 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	142 context->status = DS_NO_DISC;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	143 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	144 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	145 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	146
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	147 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	148 switch (context->requested_format)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	149 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	150 case SF_ABSOLUTE:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	151 if (context->toc_valid) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	152 lba_to_status(context, context->head_pba - LEADIN_SECTORS);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	153 context->status_buffer.format = SF_ABSOLUTE;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	154 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	155 context->status_buffer.format = SF_NOTREADY;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	156 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	157 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	158 case SF_RELATIVE:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	159 if (context->toc_valid) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	160 uint32_t lba =context->head_pba - LEADIN_SECTORS;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	161 for (uint32_t i = 0; i < context->media->num_tracks; i++)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	162 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	163 if (lba < context->media->tracks[i].end_lba) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	164 if (context->media->tracks[i].fake_pregap) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	165 if (lba > context->media->tracks[i].fake_pregap) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	166 lba -= context->media->tracks[i].fake_pregap;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	167 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	168 //relative time counts down to 0 in pregap
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	169 lba = context->media->tracks[i].fake_pregap - lba;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	170 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	171 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	172 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	173 if (lba < context->media->tracks[i].start_lba) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	174 //relative time counts down to 0 in pregap
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	175 lba = context->media->tracks[i].start_lba - lba;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	176 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	177 lba -= context->media->tracks[i].start_lba;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	178 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	179 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	180 } else if (context->media->tracks[i].fake_pregap) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	181 lba -= context->media->tracks[i].fake_pregap;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	182 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	183 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	184 lba_to_status(context, lba);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	185 context->status_buffer.format = SF_ABSOLUTE;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	186 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	187 context->status_buffer.format = SF_NOTREADY;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	188 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	189 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	190 case SF_TOCO:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	191 if (context->toc_valid) {
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	192 lba_to_status(context, context->media->tracks[context->media->num_tracks - 1].end_lba + (context->media->num_tracks > 1 ? context->media->tracks[1].fake_pregap : 0));
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	193 context->status_buffer.format = SF_TOCO;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	194 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	195 context->status_buffer.format = SF_NOTREADY;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	196 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	197 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	198 case SF_TOCT:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	199 if (context->toc_valid) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	200 context->status_buffer.b.toct.first_track_high = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	201 context->status_buffer.b.toct.first_track_low = 1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	202 context->status_buffer.b.toct.last_track_high = (context->media->num_tracks + 1) / 10;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	203 context->status_buffer.b.toct.last_track_low = (context->media->num_tracks + 1) % 10;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	204 context->status_buffer.b.toct.version = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	205 context->status_buffer.format = SF_TOCT;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	206 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	207 context->status_buffer.format = SF_NOTREADY;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	208 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	209 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	210 case SF_TOCN:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	211 if (context->toc_valid) {
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	212 uint32_t lba = context->media->tracks[context->requested_track - 1].start_lba;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	213 if (context->requested_track > 1) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	214 lba += context->media->tracks[1].fake_pregap;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	215 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	216 lba_to_status(context, lba);
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	217 context->status_buffer.b.tocn.track_low = context->requested_track % 10;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	218 context->status_buffer.format = SF_TOCN;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	219 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	220 context->status_buffer.format = SF_NOTREADY;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	221 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	222 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	223 case SF_NOTREADY:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	224 memset(&context->status_buffer, 0, sizeof(context->status_buffer) - 1);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	225 context->status_buffer.format = SF_NOTREADY;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	226 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	227 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	228 if (context->error_status == DS_STOP) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	229 context->status_buffer.status = context->status;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	230 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	231 context->status_buffer.status = context->error_status;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	232 context->error_status = DS_STOP;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	233 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	234 if (context->requested_format != SF_TOCN) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	235 context->status_buffer.b.time.flags = 0; //TODO: populate these
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	236 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	237 context->status_buffer.checksum = checksum((uint8_t *)&context->status_buffer);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	238 if (context->status_buffer.format != SF_NOTREADY) {
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	239 printf("CDD Status %X%X.%X%X%X%X%X%X.%X%X\n",
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	240 context->status_buffer.status, context->status_buffer.format,
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	241 context->status_buffer.b.time.min_high, context->status_buffer.b.time.min_low,
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	242 context->status_buffer.b.time.sec_high, context->status_buffer.b.time.sec_low,
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	243 context->status_buffer.b.time.frame_high, context->status_buffer.b.time.frame_low,
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	244 context->status_buffer.b.time.flags, context->status_buffer.checksum
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	245 );
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	246 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	247 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	248
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	249 static void run_command(cdd_mcu *context)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	250 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	251 uint8_t check = checksum((uint8_t*)&context->cmd_buffer);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	252 if (check != context->cmd_buffer.checksum) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	253 context->error_status = DS_SUM_ERROR;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	254 return;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	255 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	256 if (context->cmd_buffer.must_be_zero) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	257 context->error_status = DS_CMD_ERROR;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	258 return;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	259 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	260 switch (context->cmd_buffer.cmd_type)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	261 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	262 case CMD_NOP:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	263 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	264 case CMD_STOP:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	265 puts("CDD CMD: STOP");
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	266 context->status = DS_STOP;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	267 break;
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	268 case CMD_READ:
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	269 case CMD_SEEK: {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	270 if (context->status == DS_DOOR_OPEN \|\| context->status == DS_TRAY_MOVING \|\| context->status == DS_DISC_LEADOUT \|\| context->status == DS_DISC_LEADIN) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	271 context->error_status = DS_CMD_ERROR;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	272 break;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	273 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	274 if (context->requested_format == SF_TOCT \|\| context->requested_format == SF_TOCN) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	275 context->requested_format = SF_ABSOLUTE;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	276 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	277 if (!context->toc_valid) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	278 context->error_status = DS_CMD_ERROR;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	279 break;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	280 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	281 uint32_t lba = context->cmd_buffer.b.time.min_high * 10 + context->cmd_buffer.b.time.min_low;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	282 lba *= 60;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	283 lba += context->cmd_buffer.b.time.sec_high * 10 + context->cmd_buffer.b.time.sec_low;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	284 lba *= 75;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	285 lba += context->cmd_buffer.b.time.frame_high * 10 + context->cmd_buffer.b.time.frame_low;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	286 printf("READ/SEEK cmd for lba %d\n", lba);
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	287 if (lba >= context->media->tracks[0].fake_pregap + context->media->tracks[context->media->num_tracks - 1].end_lba) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	288 context->error_status = DS_CMD_ERROR;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	289 break;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	290 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	291 context->seek_pba = lba + LEADIN_SECTORS - 4;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	292 context->seeking = 1;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	293 context->status = context->cmd_buffer.cmd_type == CMD_READ ? DS_PLAY : DS_PAUSE;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	294 break;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	295 }
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	296 case CMD_REPORT_REQUEST:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	297 switch (context->cmd_buffer.b.format.status_type)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	298 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	299 case SF_ABSOLUTE:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	300 case SF_RELATIVE:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	301 case SF_TRACK:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	302 context->requested_format = context->cmd_buffer.b.format.status_type;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	303 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	304 case SF_TOCO:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	305 if (context->toc_valid) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	306 context->requested_format = SF_TOCO;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	307 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	308 context->error_status = DS_CMD_ERROR;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	309 context->requested_format = SF_ABSOLUTE;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	310 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	311 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	312 case SF_TOCT:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	313 if (context->toc_valid) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	314 if (context->status == DS_STOP) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	315 context->status = DS_TOC_READ;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	316 context->seeking = 1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	317 context->seek_pba = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	318 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	319 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	320 context->status = DS_TOC_READ;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	321 context->seeking = 1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	322 context->seek_pba = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	323 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	324 context->requested_format = SF_TOCT;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	325 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	326 case SF_TOCN:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	327 context->requested_track = context->cmd_buffer.b.format.track_high * 10;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	328 context->requested_track += context->cmd_buffer.b.format.track_low;
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	329 if (!context->media \|\| context->requested_track > context->media->num_tracks) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	330 context->requested_format = SF_ABSOLUTE;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	331 context->error_status = DS_CMD_ERROR;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	332 }
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	333 context->status = DS_TOC_READ;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	334 context->seeking = 1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	335 context->seek_pba = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	336 context->requested_format = SF_TOCN;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	337 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	338 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	339 printf("CDD CMD: REPORT REQUEST(%d), format set to %d\n", context->cmd_buffer.b.format.status_type, context->requested_format);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	340 break;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	341 default:
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	342 printf("CDD CMD: Unimplemented(%d)\n", context->cmd_buffer.cmd_type);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	343 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	344 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	345
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	346 #define BIT_HOCK 0x4
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	347 #define BIT_DRS 0x2
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	348 #define BIT_DTS 0x1
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	349
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	350 void cdd_mcu_run(cdd_mcu context, uint32_t cycle, uint16_t gate_array, lc8951* cdc)
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	351 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	352 uint32_t cd_cycle = mclks_to_cd_block(cycle);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	353 if (!(gate_array[GAO_CDD_CTRL] & BIT_HOCK)) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	354 //it's a little unclear if this gates the actual cd block clock or just handshaking
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	355 //assum it's actually the clock for now
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	356 context->cycle = cycle;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	357 return;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	358 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	359 uint32_t next_subcode = context->last_subcode_cycle + SECTOR_CLOCKS;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	360 uint32_t next_nibble = context->current_status_nibble >= 0 ? context->last_nibble_cycle + NIBBLE_CLOCKS : CYCLE_NEVER;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	361 uint32_t next_cmd_nibble = context->current_cmd_nibble >= 0 ? context->last_nibble_cycle + NIBBLE_CLOCKS : CYCLE_NEVER;
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	362 uint32_t next_byte = context->current_sector_byte >= 0 ? context->last_byte_cycle + BYTE_CLOCKS : CYCLE_NEVER;
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	363 for (; context->cycle < cd_cycle; context->cycle += CDD_MCU_DIVIDER)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	364 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	365 if (context->cycle >= next_subcode) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	366 context->last_subcode_cycle = context->cycle;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	367 next_subcode = context->cycle + SECTOR_CLOCKS;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	368 update_status(context);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	369 next_nibble = context->cycle;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	370 context->current_status_nibble = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	371 gate_array[GAO_CDD_STATUS] \|= BIT_DRS;
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	372 if (context->status == DS_PLAY && !context->seeking) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	373 next_byte = context->cycle;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	374 context->current_sector_byte = 0;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	375 }
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	376 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	377 if (context->cycle >= next_nibble) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	378 if (context->current_status_nibble == sizeof(cdd_status)) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	379 context->current_status_nibble = -1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	380 gate_array[GAO_CDD_STATUS] &= ~BIT_DRS;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	381 if (context->cmd_recv_pending) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	382 context->cmd_recv_pending = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	383 context->current_cmd_nibble = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	384 gate_array[GAO_CDD_STATUS] \|= BIT_DTS;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	385 next_nibble = context->cycle + NIBBLE_CLOCKS;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	386 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	387 context->cmd_recv_wait = 1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	388 next_nibble = CYCLE_NEVER;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	389 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	390 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	391 uint8_t value = ((uint8_t *)&context->status_buffer)[context->current_status_nibble];
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	392 int ga_index = GAO_CDD_STATUS + (context->current_status_nibble >> 1);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	393 if (context->current_status_nibble & 1) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	394 gate_array[ga_index] = value \| (gate_array[ga_index] & 0xFF00);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	395 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	396 gate_array[ga_index] = (value << 8) \| (gate_array[ga_index] & 0x00FF);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	397 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	398 if (context->current_status_nibble == 7) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	399 context->int_pending = 1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	400 context->next_int_cycle = cd_block_to_mclks(cycle + SECTOR_CLOCKS);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	401 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	402 context->current_status_nibble++;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	403 context->last_nibble_cycle = context->cycle;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	404 next_nibble = context->cycle + NIBBLE_CLOCKS;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	405 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	406 } else if (context->cycle >= next_cmd_nibble) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	407 if (context->current_cmd_nibble == sizeof(cdd_cmd)) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	408 next_cmd_nibble = CYCLE_NEVER;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	409 context->current_cmd_nibble = -1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	410 gate_array[GAO_CDD_STATUS] &= ~BIT_DTS;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	411 run_command(context);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	412 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	413 int ga_index = GAO_CDD_CMD + (context->current_cmd_nibble >> 1);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	414 uint8_t value = (context->current_cmd_nibble & 1) ? gate_array[ga_index] : gate_array[ga_index] >> 8;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	415 ((uint8_t *)&context->cmd_buffer)[context->current_cmd_nibble] = value;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	416 context->current_cmd_nibble++;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	417 context->last_nibble_cycle = context->cycle;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	418 next_cmd_nibble = context->cycle + NIBBLE_CLOCKS;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	419 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	420 }
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	421 if (context->cycle >= next_byte) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	422 uint8_t byte;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	423 if (context->in_fake_pregap) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	424 if (!context->current_sector_byte \|\| (context->current_sector_byte >= 16)) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	425 byte = 0;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	426 //TODO: error detection and correction bytes
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	427 } else if (context->current_sector_byte < 12) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	428 byte = 0xFF;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	429 } else if (context->current_sector_byte == 12) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	430 uint32_t minute = ((context->head_pba - LEADIN_SECTORS) / 75) / 60;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	431 byte = (minute % 10) \| ((minute / 10 ) << 4);
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	432 } else if (context->current_sector_byte == 13) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	433 uint32_t seconds = ((context->head_pba - LEADIN_SECTORS) / 75) % 60;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	434 byte = (seconds % 10) \| ((seconds / 10 ) << 4);
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	435 } else if (context->current_sector_byte == 14) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	436 uint32_t frames = (context->head_pba - LEADIN_SECTORS) % 75;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	437 byte = (frames % 10) \| ((frames / 10 ) << 4);
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	438 } else {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	439 byte = 1;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	440 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	441 } else {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	442 byte = fgetc(context->media->f);
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	443 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	444 lc8951_write_byte(cdc, cd_block_to_mclks(context->cycle), context->current_sector_byte++, byte);
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	445 context->last_byte_cycle = context->cycle;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	446 next_byte = context->cycle + BYTE_CLOCKS;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	447 if (context->current_sector_byte == 2352) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	448 context->current_sector_byte = -1;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	449
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	450 }
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	451 }
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	452 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	453 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	454
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	455 void cdd_mcu_start_cmd_recv(cdd_mcu context, uint16_t gate_array)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	456 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	457 if (context->cmd_recv_wait) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	458 context->current_cmd_nibble = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	459 gate_array[GAO_CDD_STATUS] \|= BIT_DTS;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	460 context->last_nibble_cycle = context->cycle;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	461 context->cmd_recv_wait = 0;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	462 } else {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	463 context->cmd_recv_pending = 1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	464 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	465 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	466
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	467 void cdd_hock_enabled(cdd_mcu *context)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	468 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	469 context->last_subcode_cycle = context->cycle;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	470 context->next_int_cycle = cd_block_to_mclks(context->cycle + SECTOR_CLOCKS + 7 * NIBBLE_CLOCKS);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	471 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	472
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	473 void cdd_hock_disabled(cdd_mcu *context)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	474 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	475 context->last_subcode_cycle = CYCLE_NEVER;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	476 context->next_int_cycle = CYCLE_NEVER;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	477 context->last_nibble_cycle = CYCLE_NEVER;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	478 context->current_status_nibble = -1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	479 context->current_cmd_nibble = -1;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	480 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	481
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	482 void cdd_mcu_adjust_cycle(cdd_mcu *context, uint32_t deduction)
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	483 {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	484 uint32_t cd_deduction = mclks_to_cd_block(deduction);
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	485 if (context->next_int_cycle != CYCLE_NEVER) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	486 context->next_int_cycle -= deduction;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	487 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	488 if (context->last_subcode_cycle != CYCLE_NEVER) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	489 context->last_subcode_cycle -= cd_deduction;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	490 }
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	491 if (context->last_nibble_cycle != CYCLE_NEVER) {
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	492 context->last_nibble_cycle -= cd_deduction;
7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	493 }
2062 07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	494 if (context->last_byte_cycle != CYCLE_NEVER) {
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	495 context->last_byte_cycle -= cd_deduction;
07ed42bd7b4c Some progress on CDC and CDD emulation. Now passes first 3 "CDC INIT" tests in mcd-verificator Michael Pavone <pavone@retrodev.com> parents: 2061 diff changeset	496 }
2061 7c1760b5b3e5 Implemented basic TOC functionality of CDD MCU Michael Pavone <pavone@retrodev.com> parents: diff changeset	497 }

Mercurial > repos > blastem

annotate cdd_mcu.c @ 2062:07ed42bd7b4c segacd