fix(fdc): implemented preliminary response for reading

Author: giuliof

src/fdc.c

@@ -352,12 +352,28 @@ static uint8_t exec_read_data(uint8_t value) {
 }
 
 static void post_exec_read_data(void) {
+    rw_args_t *rw_args = (rw_args_t *)args;
+
     LOG_DEBUG("Read has ended\n");
     // TODO(giulio): populate result (which is pretty the same for read,
     // write, ...)
     memset(result, 0x00, sizeof(result));
 
     // TODO(giuliof): populate result as in datasheet (see table 2)
+    /* ST0 */
+    // Current head position
+    result[0] |= rw_args->unit_select;
+    result[0] |= rw_args->head_address ? FDC_ST0_HD : 0;
+    /* ST1 */
+    result[1] |= 0; // TODO(giuliof): populate this
+    /* ST2 */
+    result[2] |= 0; // TODO(giuliof): populate this
+    /* CHR */
+    result[3] = rw_args->cylinder;
+    result[4] = rw_args->head;
+    result[5] = rw_args->record;
+    /* Sector size factor */
+    result[6] = rw_args->n;
 }
 
 // Recalibrate:

src/tests/test_fdc.c

@@ -176,17 +176,17 @@ Test(ceda_fdc, readCommand) {
     fdc_out(FDC_ADDR_DATA_REGISTER, FDC_READ_DATA);
 
     // 1st argument is number of drive
-    fdc_out(FDC_ADDR_DATA_REGISTER, 0);
+    fdc_out(FDC_ADDR_DATA_REGISTER, 2 | 1 << 2);
     // 2nd argument is cylinder number
-    fdc_out(FDC_ADDR_DATA_REGISTER, 1);
+    fdc_out(FDC_ADDR_DATA_REGISTER, 7);
     // 3rd argument is head number
     fdc_out(FDC_ADDR_DATA_REGISTER, 1);
     // 4th argument is record number
-    fdc_out(FDC_ADDR_DATA_REGISTER, 1);
+    fdc_out(FDC_ADDR_DATA_REGISTER, 5);
     // 5th argument is bytes per sector factor
     fdc_out(FDC_ADDR_DATA_REGISTER, 1);
     // 6th argument is EOT
-    fdc_out(FDC_ADDR_DATA_REGISTER, 2);
+    fdc_out(FDC_ADDR_DATA_REGISTER, 10);
     // 7th argument is GPL
     fdc_out(FDC_ADDR_DATA_REGISTER, 0);
     // 8th argument is DTL
@@ -221,5 +221,12 @@ Test(ceda_fdc, readCommand) {
     // Execution is finished, but still busy waiting for read of results
     assert_fdc_sr(FDC_ST_RQM);
 
-    // TODO: check te content of result (currently not implemented)
+    // check the content of result
+    cr_expect_eq(result[0], FDC_ST0_HD | 2);
+    cr_expect_eq(result[1], 0);
+    cr_expect_eq(result[2], 0);
+    cr_expect_eq(result[3], 7);
+    cr_expect_eq(result[4], 1);
+    cr_expect_eq(result[5], 6);
+    cr_expect_eq(result[6], 1);
 }