/************************************************************************** * int fdc_fdos_read * the length is in block number */ int fdc_fdos_read (void *buffer, int len) { FD_GEO_STRUCT *pFG = (FD_GEO_STRUCT *)floppy_type; FDC_COMMAND_STRUCT *pCMD = &cmd; return (fdc_read_data (buffer, len, pCMD, pFG)); }
void t_FDC::Emulate(int iCycleCount) { if (phase == EXEC_PHASE) { timeout -= iCycleCount; if (timeout <= 0) { flags |= OVERRUN_flag; if (cmd_direction == FDC_TO_CPU) { fdc_read_data(); } else { fdc_write_data(0xff); } } } }
/**************************************************************************** * main routine do_fdcboot */ int do_fdcboot (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]) { FD_GEO_STRUCT *pFG = (FD_GEO_STRUCT *)floppy_type; FDC_COMMAND_STRUCT *pCMD = &cmd; unsigned long addr,imsize; image_header_t *hdr; /* used for fdc boot */ unsigned char boot_drive; int i,nrofblk; char *ep; int rcode = 0; #if defined(CONFIG_FIT) const void *fit_hdr; #endif switch (argc) { case 1: addr = CFG_LOAD_ADDR; boot_drive=CFG_FDC_DRIVE_NUMBER; break; case 2: addr = simple_strtoul(argv[1], NULL, 16); boot_drive=CFG_FDC_DRIVE_NUMBER; break; case 3: addr = simple_strtoul(argv[1], NULL, 16); boot_drive=simple_strtoul(argv[2], NULL, 10); break; default: printf ("Usage:\n%s\n", cmdtp->usage); return 1; } /* setup FDC and scan for drives */ if(fdc_setup(boot_drive,pCMD,pFG)==FALSE) { printf("\n** Error in setup FDC **\n"); return 1; } if(fdc_check_drive(pCMD,pFG)==FALSE) { printf("\n** Error in check_drives **\n"); return 1; } if((pCMD->flags&(1<<boot_drive))==0) { /* drive not available */ printf("\n** Drive %d not availabe **\n",boot_drive); return 1; } if((pCMD->flags&(0x10<<boot_drive))==0) { /* no disk inserted */ printf("\n** No disk inserted in drive %d **\n",boot_drive); return 1; } /* ok, we have a valid source */ pCMD->drive=boot_drive; /* read first block */ pCMD->blnr=0; if(fdc_read_data((unsigned char *)addr,1,pCMD,pFG)==FALSE) { printf("\nRead error:"); for(i=0;i<7;i++) printf("result%d: 0x%02X\n",i,pCMD->result[i]); return 1; } switch (genimg_get_format ((void *)addr)) { case IMAGE_FORMAT_LEGACY: hdr = (image_header_t *)addr; image_print_contents (hdr); imsize = image_get_image_size (hdr); break; #if defined(CONFIG_FIT) case IMAGE_FORMAT_FIT: fit_hdr = (const void *)addr; if (!fit_check_format (fit_hdr)) { puts ("** Bad FIT image format\n"); return 1; } puts ("Fit image detected...\n"); imsize = fit_get_size (fit_hdr); break; #endif default: puts ("** Unknown image type\n"); return 1; } nrofblk=imsize/512; if((imsize%512)>0) nrofblk++; printf("Loading %ld Bytes (%d blocks) at 0x%08lx..\n",imsize,nrofblk,addr); pCMD->blnr=0; if(fdc_read_data((unsigned char *)addr,nrofblk,pCMD,pFG)==FALSE) { /* read image block */ printf("\nRead error:"); for(i=0;i<7;i++) printf("result%d: 0x%02X\n",i,pCMD->result[i]); return 1; } printf("OK %ld Bytes loaded.\n",imsize); flush_cache (addr, imsize); #if defined(CONFIG_FIT) /* This cannot be done earlier, we need complete FIT image in RAM first */ if (genimg_get_format ((void *)addr) == IMAGE_FORMAT_FIT) fit_print_contents ((const void *)addr); #endif /* Loading ok, update default load address */ load_addr = addr; /* Check if we should attempt an auto-start */ if (((ep = getenv("autostart")) != NULL) && (strcmp(ep,"yes") == 0)) { char *local_args[2]; extern int do_bootm (cmd_tbl_t *, int, int, char *[]); local_args[0] = argv[0]; local_args[1] = NULL; printf ("Automatic boot of image at addr 0x%08lX ...\n", addr); do_bootm (cmdtp, 0, 1, local_args); rcode ++; } return rcode; }
/**************************************************************************** * main routine do_fdcboot */ int do_fdcboot (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) { FD_GEO_STRUCT *pFG = (FD_GEO_STRUCT *)floppy_type; FDC_COMMAND_STRUCT *pCMD = &cmd; unsigned long addr,imsize; #if defined(CONFIG_IMAGE_FORMAT_LEGACY) image_header_t *hdr; /* used for fdc boot */ #endif unsigned char boot_drive; int i,nrofblk; #if defined(CONFIG_FIT) const void *fit_hdr = NULL; #endif switch (argc) { case 1: addr = CONFIG_SYS_LOAD_ADDR; boot_drive=CONFIG_SYS_FDC_DRIVE_NUMBER; break; case 2: addr = simple_strtoul(argv[1], NULL, 16); boot_drive=CONFIG_SYS_FDC_DRIVE_NUMBER; break; case 3: addr = simple_strtoul(argv[1], NULL, 16); boot_drive=simple_strtoul(argv[2], NULL, 10); break; default: return CMD_RET_USAGE; } /* setup FDC and scan for drives */ if (fdc_setup(boot_drive, pCMD, pFG) == false) { printf("\n** Error in setup FDC **\n"); return 1; } if (fdc_check_drive(pCMD, pFG) == false) { printf("\n** Error in check_drives **\n"); return 1; } if((pCMD->flags&(1<<boot_drive))==0) { /* drive not available */ printf("\n** Drive %d not availabe **\n",boot_drive); return 1; } if((pCMD->flags&(0x10<<boot_drive))==0) { /* no disk inserted */ printf("\n** No disk inserted in drive %d **\n",boot_drive); return 1; } /* ok, we have a valid source */ pCMD->drive=boot_drive; /* read first block */ pCMD->blnr=0; if (fdc_read_data((unsigned char *)addr, 1, pCMD, pFG) == false) { printf("\nRead error:"); for(i=0;i<7;i++) printf("result%d: 0x%02X\n",i,pCMD->result[i]); return 1; } switch (genimg_get_format ((void *)addr)) { #if defined(CONFIG_IMAGE_FORMAT_LEGACY) case IMAGE_FORMAT_LEGACY: hdr = (image_header_t *)addr; image_print_contents (hdr); imsize = image_get_image_size (hdr); break; #endif #if defined(CONFIG_FIT) case IMAGE_FORMAT_FIT: fit_hdr = (const void *)addr; puts ("Fit image detected...\n"); imsize = fit_get_size (fit_hdr); break; #endif default: puts ("** Unknown image type\n"); return 1; } nrofblk=imsize/512; if((imsize%512)>0) nrofblk++; printf("Loading %ld Bytes (%d blocks) at 0x%08lx..\n",imsize,nrofblk,addr); pCMD->blnr=0; if (fdc_read_data((unsigned char *)addr, nrofblk, pCMD, pFG) == false) { /* read image block */ printf("\nRead error:"); for(i=0;i<7;i++) printf("result%d: 0x%02X\n",i,pCMD->result[i]); return 1; } printf("OK %ld Bytes loaded.\n",imsize); flush_cache (addr, imsize); #if defined(CONFIG_FIT) /* This cannot be done earlier, we need complete FIT image in RAM first */ if (genimg_get_format ((void *)addr) == IMAGE_FORMAT_FIT) { if (!fit_check_format (fit_hdr)) { puts ("** Bad FIT image format\n"); return 1; } fit_print_contents (fit_hdr); } #endif /* Loading ok, update default load address */ load_addr = addr; return bootm_maybe_autostart(cmdtp, argv[0]); }
void fdc_write(unsigned char a) { // Write byte to data register static int cmdlen = 9; // length of FDC command #ifdef FDC_DEBUG printf("FDC DATA WRITE = 0x%x\n", a); #endif switch(phase) { case P_COMMAND: fdccommand[CmdByte] = a; // store part of command if (CmdByte == 0) { // first byte of command switch(a&0x1F) { case CMD_READDATA: case CMD_READDELETEDDATA: case CMD_WRITEDATA: case CMD_WRITEDELETEDDATA: case CMD_READDIAGNOSTIC: case CMD_SCANEQUAL: case CMD_SCANLOWEQUAL: case CMD_SCANHIGHEQUAL: cmdlen = 9; break; case CMD_WRITEID: cmdlen = 6; break; case CMD_SPECIFY: case CMD_SEEK: cmdlen = 3; break; case CMD_READID: case CMD_RECALIBRATE: case CMD_SENSEDRV: cmdlen = 2; break; case CMD_SENSEINT: case CMD_VERSION: cmdlen = 1; break; default: // Invalid Command cmdlen = 1; printf("Invalid FDC Command received: 0x%x\n", a); break; } // Set CB (Busy) flag //fdc_status_main|=MAIN_CB; } CmdByte++; if (CmdByte == cmdlen) { // Command phase finished switch(fdccommand[0]&0x1F) { case CMD_READDATA: fdc_read_data(); break; case CMD_READDELETEDDATA: printf("*** Unimplemented FDC Command READ DELETED DATA\n"); break; case CMD_WRITEDATA: printf("*** Unimplemented FDC Command WRITE DATA\n"); break; case CMD_WRITEDELETEDDATA: printf("*** Unimplemented FDC Command WRITE DELETED DATA\n"); break; case CMD_READDIAGNOSTIC: printf("*** Unimplemented FDC Command READ DIAGNOSTIC\n"); break; case CMD_READID: // Read sector ID fdc_read_id(); break; case CMD_WRITEID: printf("*** Unimplemented FDC Command WRITE ID\n"); break; case CMD_SCANEQUAL: printf("*** Unimplemented FDC Command SCAN EQUAL\n"); break; case CMD_SCANLOWEQUAL: printf("*** Unimplemented FDC Command SCAN LOW OR EQUAL\n"); break; case CMD_SCANHIGHEQUAL: printf("*** Unimplemented FDC Command SCAN HIGH OR EQUAL\n"); break; case CMD_RECALIBRATE: // Reset to track 0 fdc_seek(0); break; case CMD_SENSEINT: // Get Interrupt status register fdc_senseint(); break; case CMD_SPECIFY: // We really don't need to do anything here. This command only sets // physical timing parameters. These are not relevant to a virtual FDC. fdc_status_main&=~MAIN_CB; // Clear CB (busy) flag break; case CMD_SENSEDRV: printf("*** Unimplemented FDC Command SENSE DRIVE\n"); break; case CMD_VERSION: printf("*** Unimplemented FDC Command VERSION\n"); break; case CMD_SEEK: // Seek to a specified track fdc_seek(fdccommand[2]); break; default: break; } CmdByte = 0; } break; case P_EXECUTION: // Execution phase break; case P_RESULT: // There should be no write acces in result phase break; } }