STDMETHODIMP CLibrary::create(BSTR f, BSTR d, BSTR c, IDisk **ppDisk) { DSK_PDRIVER pd; dsk_err_t err; char *filename; char *driver; char *compress; if (!f || !ppDisk) { return MapError(DSK_ERR_BADPTR); } filename = get_string(f); driver = get_string(d); compress = get_string(c); if (driver[0] == 0) { dsk_free(driver); driver = NULL; } if (compress[0] == 0) { dsk_free(compress); compress = NULL; } err = dsk_creat(&pd, filename, driver, compress); if (filename) dsk_free(filename); if (driver) dsk_free(driver); if (compress) dsk_free(compress); if (err) { return MapError(err); } HRESULT hr = CDisk::CreateInstance(ppDisk); if (FAILED(hr)) return hr; ((CDisk *)ppDisk[0])->m_driver = pd; return hr; }
dsk_err_t DriveSelectPage::CreateDisc(DSK_PDRIVER *pdsk) { wxString &filename = GetFilename(); wxCharBuffer buf(filename.mb_str(wxConvUTF8)); dsk_err_t err = dsk_creat(pdsk, buf, GetType(), GetCompress()); if (!err) { long retries; if (!m_retries.ToLong(&retries)) retries = 1; dsk_set_retry(*pdsk, retries); if (GetForceHead() >= 0) { dsk_set_option(*pdsk, "HEAD", GetForceHead()); } if (GetDoubleStep()) { dsk_set_option(*pdsk, "DOUBLESTEP", 1); } } return err; }
int do_format(char *outfile, char *outtyp, char *outcomp, int forcehead, dsk_format_t format) { DSK_PDRIVER outdr = NULL; dsk_err_t e; dsk_pcyl_t cyl; dsk_phead_t head; DSK_GEOMETRY dg; dsk_cchar_t fdesc; dsk_reportfunc_set(report, report_end); e = dsk_creat(&outdr, outfile, outtyp, outcomp); if (!e) e = dsk_set_retry(outdr, retries); if (!e && forcehead >= 0) e = dsk_set_forcehead(outdr, forcehead); if (!e) e = dg_stdformat(&dg, format, NULL, &fdesc); if (!e) { printf("Formatting %s as %s\n", outfile, fdesc); for (cyl = 0; cyl < dg.dg_cylinders; cyl++) { for (head = 0; head < dg.dg_heads; head++) { printf("Cyl %02d/%02d Head %d/%d\r", cyl +1, dg.dg_cylinders, head+1, dg.dg_heads); fflush(stdout); if (!e) e = dsk_apform(outdr, &dg, cyl, head, 0xE5); if (e) break; } } } /* Create a disc spec on the first sector, if the format's recognised */ if (!e) { unsigned char bootsec[512]; unsigned int do_bootsec = 0; memset(bootsec, 0xE5, sizeof(bootsec)); switch(format) { case FMT_180K: memcpy(bootsec, spec180, 10); do_bootsec = 1; break; case FMT_CPCSYS: memcpy(bootsec, spec169, 10); do_bootsec = 1; break; case FMT_CPCDATA: break; case FMT_200K: memcpy(bootsec, spec200, 10); do_bootsec = 1; break; case FMT_720K: memcpy(bootsec, spec720, 10); do_bootsec = 1; break; case FMT_800K: memcpy(bootsec, spec800, 10); do_bootsec = 1; break; default: break; } if (do_bootsec) e = dsk_lwrite(outdr, &dg, bootsec, 0); } printf("\r \r"); if (outdr) dsk_close(&outdr); if (e) { fprintf(stderr, "%s\n", dsk_strerror(e)); return 1; } return 0; }
/* Decode an RPC packet and execute it. * If nRefCount is nonzero, it is increased each time a dsk_open or dsk_creat * succeeds, and decreased when a dsk_close succeeds. This allows a server * program to terminate automatically when the reference count reaches 0. * * The only RPC codes that are currently obeyed are those sent by drvwin32.c * through rpccli.c */ LDPUBLIC32 dsk_err_t LDPUBLIC16 dsk_rpc_server(unsigned char *input, int inp_len, unsigned char *output, int *out_len, int *nRefCount) { dsk_err_t err, err2; int16 function; DSK_DRIVER *pDriver; DSK_GEOMETRY geom; DSK_FORMAT fmt, *pfmt; int32 nd, int1, int2, int3, int4, int5, int6, int7; int16 filler; char *str1, *str2, *str3; dsk_psect_t rcount; DSK_FORMAT *trkids; unsigned int nDriver, n; unsigned char secbuf[8192], *pbuf; unsigned char status; int deleted, value; int16 props[sizeof(DRV_CLASS)]; err = dsk_unpack_i16(&input, &inp_len, &function); if (err) return err; switch(function) { case RPC_DSK_OPEN: err = dsk_unpack_string(&input, &inp_len, &str1); if (err) return err; err = dsk_unpack_string(&input, &inp_len, &str2); if (err) return err; err = dsk_unpack_string(&input, &inp_len, &str3); if (err) return err; err2= dsk_open(&pDriver, str1, str2, str3); err = dsk_map_dtoi(pDriver, &nDriver); if (err) return err; err = dsk_pack_err (&output, out_len, err2); if (err) return err; err = dsk_pack_i32 (&output, out_len, nDriver); if (err) return err; if (nRefCount && err2 == DSK_ERR_OK) ++(*nRefCount); return DSK_ERR_OK; case RPC_DSK_CREAT: err = dsk_unpack_string(&input, &inp_len, &str1); if (err) return err; err = dsk_unpack_string(&input, &inp_len, &str2); if (err) return err; err = dsk_unpack_string(&input, &inp_len, &str3); if (err) return err; err2= dsk_creat(&pDriver, str1, str2, str3); err = dsk_map_dtoi(pDriver, &nDriver); if (err) return err; err = dsk_pack_err (&output, out_len, err2); if (err) return err; err = dsk_pack_i32 (&output, out_len, nDriver); if (err) return err; if (nRefCount && err2 == DSK_ERR_OK) ++(*nRefCount); return DSK_ERR_OK; case RPC_DSK_CLOSE: err = dsk_unpack_i32(&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_close(&pDriver); err = dsk_pack_err(&output, out_len, err2); if (err) return err; if (nRefCount) --(*nRefCount); return DSK_ERR_OK; case RPC_DSK_PREAD: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int3); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_pread(pDriver, &geom, secbuf, (dsk_pcyl_t)int1, (dsk_phead_t)int2, (dsk_psect_t)int3); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_bytes(&output, out_len, secbuf, geom.dg_secsize); if (err) return err; return DSK_ERR_OK; case RPC_DSK_PWRITE: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_bytes(&input, &inp_len, &pbuf); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int3); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_pwrite(pDriver, &geom, pbuf, (dsk_pcyl_t)int1, (dsk_phead_t)int2, (dsk_psect_t)int3); err = dsk_pack_err(&output, out_len, err2); if (err) return err; return DSK_ERR_OK; case RPC_DSK_PFORMAT: pfmt = (DSK_FORMAT *)secbuf; err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; for (n = 0; n < geom.dg_sectors; n++) { err = dsk_unpack_format(&input, &inp_len, &pfmt[n]); if (err) return err; } err = dsk_unpack_i16 (&input, &inp_len, &filler); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_pformat(pDriver, &geom, (dsk_pcyl_t)int1, (dsk_phead_t)int2, pfmt, (unsigned char)filler); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_geom(&output, out_len, &geom); if (err) return err; return DSK_ERR_OK; case RPC_DSK_PSECID: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_psecid(pDriver, &geom, (dsk_pcyl_t)int1, (dsk_phead_t)int2, &fmt); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_format(&output, out_len, &fmt); if (err) return err; return DSK_ERR_OK; case RPC_DSK_DRIVE_STATUS: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_drive_status(pDriver, &geom, (dsk_phead_t)int1, &status); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_i16(&output, out_len, status); if (err) return err; return DSK_ERR_OK; case RPC_DSK_GETGEOM: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_getgeom(pDriver, &geom); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_geom(&output, out_len, &geom); if (err) return err; return DSK_ERR_OK; case RPC_DSK_PSEEK: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_pseek(pDriver, &geom, (dsk_pcyl_t)int1, (dsk_phead_t)int2); err = dsk_pack_err(&output, out_len, err2); if (err) return err; return DSK_ERR_OK; case RPC_DSK_XREAD: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int3); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int4); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int5); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int6); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int7); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; deleted = int7; err2= dsk_xread(pDriver, &geom, secbuf, (dsk_pcyl_t)int1, (dsk_phead_t)int2, (dsk_pcyl_t)int3, (dsk_phead_t)int4, (dsk_psect_t)int5, (size_t)int6, &deleted); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_bytes(&output, out_len, secbuf, int6); if (err) return err; err = dsk_pack_i32(&output, out_len, deleted); return DSK_ERR_OK; case RPC_DSK_XWRITE: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_bytes(&input, &inp_len, &pbuf); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int3); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int4); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int5); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int6); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int7); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_xwrite(pDriver, &geom, pbuf, (dsk_pcyl_t)int1, (dsk_phead_t)int2, (dsk_pcyl_t)int3, (dsk_phead_t)int4, (dsk_psect_t)int5, (size_t)int6, (int)int7); err = dsk_pack_err(&output, out_len, err2); if (err) return err; return DSK_ERR_OK; case RPC_DSK_TRACKIDS: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2 = dsk_ptrackids(pDriver, &geom, int1, int2, &rcount, &trkids); if (err2 || !trkids) rcount = 0; err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_i32(&output, out_len, rcount); if (err) return err; for (n = 0; n < rcount; n++) { err = dsk_pack_format(&output, out_len, &trkids[n]); if (err) return err; } if (trkids) dsk_free(trkids); return DSK_ERR_OK; case RPC_DSK_PTREAD: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_ptread(pDriver, &geom, secbuf, (dsk_pcyl_t)int1, (dsk_phead_t)int2); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_bytes(&output, out_len, secbuf, geom.dg_secsize * geom.dg_sectors); if (err) return err; return DSK_ERR_OK; case RPC_DSK_XTREAD: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int3); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int4); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_xtread(pDriver, &geom, secbuf, (dsk_pcyl_t)int1, (dsk_phead_t)int2, (dsk_pcyl_t)int3, (dsk_phead_t)int4); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_bytes(&output, out_len, secbuf, geom.dg_secsize * geom.dg_sectors); if (err) return err; return DSK_ERR_OK; case RPC_DSK_OPTION_ENUM: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_option_enum(pDriver, int1, &str1); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_string(&output, out_len, str1); if (err) return err; return DSK_ERR_OK; case RPC_DSK_OPTION_SET: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_string(&input, &inp_len, &str1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_set_option(pDriver, str1, int1); err = dsk_pack_err(&output, out_len, err2); if (err) return err; return DSK_ERR_OK; case RPC_DSK_OPTION_GET: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_string(&input, &inp_len, &str1); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_get_option(pDriver, str1, &value); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_i32 (&output, out_len, value); if (err) return err; return DSK_ERR_OK; case RPC_DSK_GETCOMMENT: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_get_comment(pDriver, &str1); err = dsk_pack_err(&output, out_len, err2); if (err) return err; err = dsk_pack_string(&output, out_len, str1); if (err) return err; return DSK_ERR_OK; case RPC_DSK_SETCOMMENT: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err = dsk_unpack_string(&input, &inp_len, &str1); if (err) return err; err2= dsk_set_comment(pDriver, str1); err = dsk_pack_err(&output, out_len, err2); if (err) return err; return DSK_ERR_OK; case RPC_DSK_RTREAD: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_unpack_geom(&input, &inp_len, &geom); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int1); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int2); if (err) return err; err = dsk_unpack_i32 (&input, &inp_len, &int3); if (err) return err; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; err2= dsk_rtread(pDriver, &geom, secbuf, (dsk_pcyl_t)int1, (dsk_phead_t)int2, int3); err = dsk_pack_err(&output, out_len, err2); if (err) return err; /* XXX This is a completely arbitrary buffer size */ err = dsk_pack_i32(&output, out_len, geom.dg_secsize * geom.dg_sectors); if (err) return err; err = dsk_pack_bytes(&output, out_len, secbuf, geom.dg_secsize * geom.dg_sectors); if (err) return err; return DSK_ERR_OK; /* Return a list of implemented functions */ case RPC_DSK_PROPERTIES: err = dsk_unpack_i32 (&input, &inp_len, &nd); if (err) return err; nDriver = (unsigned int)nd; err = dsk_map_itod(nDriver, &pDriver); if (err) return err; int1 = 0; /* Count of implemented functions */ #define PROPCHECK(func, rid) if (pDriver->dr_class->func) props[int1++] = rid; PROPCHECK(dc_open, RPC_DSK_OPEN) PROPCHECK(dc_creat, RPC_DSK_CREAT) PROPCHECK(dc_close, RPC_DSK_CLOSE) PROPCHECK(dc_read, RPC_DSK_PREAD) PROPCHECK(dc_write, RPC_DSK_PWRITE) PROPCHECK(dc_format, RPC_DSK_PFORMAT) PROPCHECK(dc_secid, RPC_DSK_PSECID) PROPCHECK(dc_getgeom, RPC_DSK_GETGEOM) PROPCHECK(dc_xseek, RPC_DSK_PSEEK) PROPCHECK(dc_status, RPC_DSK_DRIVE_STATUS) PROPCHECK(dc_xread, RPC_DSK_XREAD) PROPCHECK(dc_xwrite, RPC_DSK_XWRITE) PROPCHECK(dc_tread, RPC_DSK_PTREAD) PROPCHECK(dc_xtread, RPC_DSK_XTREAD) PROPCHECK(dc_option_enum, RPC_DSK_OPTION_ENUM) PROPCHECK(dc_option_get, RPC_DSK_OPTION_GET) PROPCHECK(dc_option_set, RPC_DSK_OPTION_SET) PROPCHECK(dc_trackids, RPC_DSK_TRACKIDS) PROPCHECK(dc_rtread, RPC_DSK_RTREAD) #undef PROPCHECK props[int1++] = RPC_DSK_PROPERTIES; err = dsk_pack_err(&output, out_len, DSK_ERR_OK); if (err) return err; err = dsk_pack_i16(&output, out_len, (unsigned short)int1); if (err) return err; for (int2 = 0; int2 < int1; int2++) { err = dsk_pack_i16(&output, out_len, props[int2]); if (err) return err; } err = dsk_pack_string(&output, out_len, pDriver->dr_class->dc_description); if (err) return err; return DSK_ERR_OK; /* Unsupported function. Return DSK_ERR_UNKRPC */ default: err2 = dsk_pack_err(&output, out_len, DSK_ERR_UNKRPC); return DSK_ERR_OK; } }
int main(int argc, char *argv[]) { FILE *fp; struct disk_side *sides, *curr_side; struct disk_track *curr_track; struct disk_sector *curr_sector; DSK_GEOMETRY geom; DSK_PDRIVER newdisk; DSK_FORMAT *format; dsk_err_t err; int i; char *secdata; if (argc != 3) { fprintf(stderr, "usage: %s infile outfile\n", argv[0]); exit(1); } fp = fopen(argv[1], "r"); if (fp == NULL) { fprintf(stderr, "unable to open file: %s\n", argv[1]); exit(1); } sides = parse_image(fp); memset(&geom, 0, sizeof(DSK_GEOMETRY)); geom.dg_cylinders = max_tracks; geom.dg_heads = max_sides; geom.dg_sectors = max_sectors; geom.dg_secbase = 1; /* perhaps this should be determined from file? */ geom.dg_secsize = sector_size; format = malloc(geom.dg_sectors*sizeof(DSK_FORMAT)); secdata = malloc(geom.dg_secsize); if ((format == NULL) || (secdata == NULL)) { fprintf(stderr, "main: out of memory\n"); exit(1); } if (dsk_creat(&newdisk, argv[2], "dsk", NULL) != DSK_ERR_OK) { fprintf(stderr, "main: error in dsk_creat\n"); exit(1); } for (i=0; i<max_sides; i++) if (dsk_apform(newdisk, &geom, 0, i, 0xE5) != DSK_ERR_OK) { fprintf(stderr, "main: error formatting inital cylinder\n"); exit(1); } curr_side = sides; while (curr_side != NULL) { /* printf("Side = %i\n", curr_side->id); */ curr_track = curr_side->tracks; while (curr_track != NULL) { /*printf(" Track = %i\n", curr_track->id); */ curr_sector = curr_track->sectors; i = 0; while (curr_sector != NULL) { /* printf(" Sector = %i\n", curr_sector->id);*/ format[i].fmt_cylinder = curr_sector->logical_track; format[i].fmt_head = curr_sector->logical_side; format[i].fmt_sector = curr_sector->id; format[i].fmt_secsize = curr_sector->length; curr_sector = curr_sector->next; i++; } if ((err = dsk_pformat(newdisk, &geom, curr_track->id, curr_side->id, format, 0xE5)) != DSK_ERR_OK) { fprintf(stderr, "main: error in dsk_pformat(%i)\n", err); exit(1); } curr_sector = curr_track->sectors; while (curr_sector != NULL) { fseek(fp, curr_sector->ofs, SEEK_SET); if (fread(secdata, 1, curr_sector->length, fp) != curr_sector->length) { fprintf(stderr, "main: error reading input file sector\n"); exit(1); } if ((err = dsk_xwrite(newdisk, &geom, secdata, curr_track->id, curr_side->id, curr_sector->logical_track, curr_sector->logical_side, curr_sector->id, curr_sector->length, 0)) != DSK_ERR_OK) { fprintf(stderr, "main: error in dsk_pwrite (%i, sec=%i, side=%i, track=%i) \n", err, curr_sector->id, curr_sector->logical_side, curr_sector->logical_track); exit(1); } curr_sector = curr_sector->next; } curr_track = curr_track->next; } curr_side = curr_side->next; } printf("Sides: %2i Tracks: %2i Sectors: %2i\n", max_sides, max_tracks, max_sectors); dsk_close(&newdisk); fclose(fp); return 0; }
dsk_err_t p3fs_mkfs(PLUS3FS *pfs, const char *name, const char *type, const char *compression, unsigned char *boot_spec, int timestamped) { dsk_err_t err; dsk_ltrack_t track; int heads, dirent; char msg[50]; PLUS3FS fs; if (pfs == NULL) { return DSK_ERR_BADPTR; } fs = malloc(sizeof(PLUS3FS_IMPL)); *pfs = fs; memset(fs, 0, sizeof(*fs)); heads = (boot_spec[1] & 3) ? 2 : 1; /* Work out how big the buffers for the boot sector and directory * need to be. Start by getting the drive geometry straight. */ err = dg_pcwgeom(&fs->geom, boot_spec); if (err) return err; /* Now the CP/M filesystem parameters */ fs->blocksize = 128 << (boot_spec[6]); /* Block size */ fs->offset = boot_spec[5]; /* Reserved tracks */ fs->maxtrack = heads * boot_spec[2]; fs->dirblocks = boot_spec[7]; fs->nextblock = fs->dirblocks; /* First free block */ fs->maxdir = (fs->dirblocks * fs->blocksize) / 32; /* Max block number is number of usable sectors divided by * sectors per block */ fs->maxblock = ((fs->maxtrack - fs->offset) * fs->geom.dg_sectors) / (fs->blocksize / fs->geom.dg_secsize); --fs->maxblock; if (fs->maxblock < 256) fs->exm = (fs->blocksize / 1024) - 1; else fs->exm = (fs->blocksize / 2048) - 1; /* Allocate the buffers */ fs->bootsec = malloc(fs->geom.dg_secsize + 32 * fs->maxdir); if (!fs->bootsec) return DSK_ERR_NOMEM; fs->cpmdir = fs->bootsec + fs->geom.dg_secsize; memset(fs->cpmdir, 0xE5, 32 * fs->maxdir); fs->timestamped = timestamped; if (timestamped) { for (dirent = 3; dirent < fs->maxdir; dirent += 4) { memset(fs->cpmdir + 32 * dirent, 0, 32); fs->cpmdir[32 * dirent] = 0x21; } } memset(fs->bootsec, 0xe5, fs->geom.dg_secsize); memcpy(fs->bootsec, boot_spec, 10); /* Create a new DSK file */ err = dsk_creat(&fs->drive, name, type, compression); if (err) return err; /* Format all its tracks */ for (track = 0; track < fs->maxtrack; track++) { sprintf(msg, "Formatting track %d/%d", track, fs->maxtrack); dsk_report(msg); if (!err) err = dsk_alform(fs->drive, &fs->geom, track, 0xe5); } dsk_report("Writing boot sector"); if (!err) err = dsk_lwrite(fs->drive, &fs->geom, fs->bootsec, 0); dsk_report_end(); return err; }
int do_test(char *outfile, char *outtyp, char *outcomp, int forcehead) { DSK_PDRIVER outdr = NULL; dsk_err_t e; DSK_GEOMETRY dg, dg2; static DSK_FORMAT fmt[9] = { { 0, 0, 1, 512 }, { 0, 0, 3, 512 }, { 3, 1, 5, 512 }, { 0, 0, 7, 512 }, { 0, 0, 9, 512 }, { 0, 1, 2, 512 }, { 0, 0, 4, 512 }, { 2, 0, 6, 512 }, { 0, 0, 8, 512 }, }; static DSK_FORMAT fmt2[9] = { { 4, 0, 1, 512 }, { 4, 0, 3, 512 }, { 4, 0, 5, 512 }, { 4, 0, 7, 512 }, { 4, 0, 9, 512 }, { 4, 0, 2, 512 }, { 4, 0, 4, 512 }, { 4, 0, 6, 512 }, { 4, 0, 8, 512 }, }; DSK_FORMAT secid, *pfmt; char *comment; unsigned char status; dsk_psect_t count, n; char *optname; int value; dsk_reportfunc_set(report, report_end); dg_stdformat(&dg, FMT_180K, NULL, NULL); if (t80) dg.dg_cylinders = 80; printf("Checking dsk_creat\n"); e = dsk_creat(&outdr, outfile, outtyp, outcomp); CHECKERR("dsk_creat") else { dsk_set_option(outdr, "REMOTE:TESTING", 1); printf("Checking set_comment\n"); e = dsk_set_comment(outdr, "Example comment"); CHECKERR3("dsk_set_comment"); printf("Checking pformat\n"); e = dsk_pformat(outdr, &dg, 0, 0, fmt, 0xE5); CHECKERR("dsk_pformat") printf("Checking apform\n"); e = dsk_apform(outdr, &dg, 1, 0, 0xF6); CHECKERR("dsk_apform") printf("Checking lformat\n"); e = dsk_lformat(outdr, &dg, 2, fmt2, 0xD4); CHECKERR("dsk_pformat") printf("Checking ptrackids\n"); e = dsk_ptrackids(outdr, &dg, 0, 0, &count, &pfmt); CHECKERR("dsk_ptrackids") else { dsk_psect_t n; printf("Cyl Head Sec Size\n"); printf("-----------------\n"); for (n = 0; n < count; n++) { printf("%3d %3d %3d %4d\n", pfmt[n].fmt_cylinder, pfmt[n].fmt_head, pfmt[n].fmt_sector, (int)pfmt[n].fmt_secsize); } printf("-----------------\n"); dsk_free(pfmt); } memset(secbuf, 0, sizeof(secbuf)); memcpy(secbuf, spec180, sizeof(spec180)); printf("Checking dsk_lwrite\n"); e = dsk_lwrite(outdr, &dg, secbuf, 0); CHECKERR("dsk_lwrite") strcpy((char *)secbuf, "Cyl=3 Head=1 Sec=5"); printf("Checking dsk_xwrite\n"); e = dsk_xwrite(outdr, &dg, secbuf, 0, 0, 3, 1, 5, 512, 0); CHECKERR("dsk_xwrite") printf("Checking dsk_psecid\n"); e = dsk_psecid(outdr, &dg, 1, 0, &secid); CHECKERR("dsk_psecid") else { printf("%3d %3d %3d %4d\n", secid.fmt_cylinder, secid.fmt_head, secid.fmt_sector, (int)secid.fmt_secsize); if (secid.fmt_cylinder != 1 || secid.fmt_head != 0 || secid.fmt_secsize != 512) { ++failures; printf("-- mismatch!\n"); } } } if (outdr) { dsk_close(&outdr); CHECKERR("dsk_close") } printf("Checking dsk_open\n"); e = dsk_open(&outdr, outfile, outtyp, outcomp); CHECKERR("dsk_open") else { dsk_set_option(outdr, "REMOTE:TESTING", 1); printf("Checking dsk_getgeom\n"); e = dsk_getgeom(outdr, &dg2); if (t80 && dg2.dg_cylinders == 40) dg2.dg_cylinders = 80; CHECKERR("dsk_getgeom") else if (memcmp(&dg, &dg2, sizeof(dg))) { ++failures; printf("-- mismatch!\n"); printf("Cyls: %3d %3d\n", dg.dg_cylinders, dg2.dg_cylinders); printf("Heads: %3d %3d\n", dg.dg_heads, dg2.dg_heads); printf("Secs: %3d %3d\n", dg.dg_sectors, dg2.dg_sectors); } printf("Checking dsk_lread\n"); e = dsk_lread(outdr, &dg, secbuf, 0); CHECKERR("dsk_lread") else if (memcmp(secbuf, spec180, sizeof(spec180))) { ++failures; printf("-- mismatch!\n"); } printf("Checking dsk_xread\n"); e = dsk_xread(outdr, &dg, secbuf, 0, 0, 3, 1, 5, 512, NULL); CHECKERR("dsk_xread") else if (strcmp((char *)secbuf, "Cyl=3 Head=1 Sec=5")) { ++failures; printf("-- mismatch!\n"); } printf("Checking dsk_lseek\n"); e = dsk_lseek(outdr, &dg, 1); CHECKERR("dsk_lseek") printf("Checking dsk_drive_status\n"); e = dsk_drive_status(outdr, &dg, 0, &status); CHECKERR("dsk_drive_status") else printf("-- status=0x%02x\n", status); printf("Checking dsk_tread\n"); e = dsk_ptread(outdr, &dg, trkbuf, 1, 0); CHECKERR("dsk_ptread") else { for (n = 0; n < 4608; n++) if (trkbuf[n] != 0xF6) { printf("-- mismatch!\n"); ++failures; break; } } printf("Checking dsk_xtread\n"); e = dsk_xtread(outdr, &dg, trkbuf, 2, 0, 4, 0); CHECKERR("dsk_xtread") else { for (n = 0; n < 4608; n++) if (trkbuf[n] != 0xD4) { printf("-- mismatch!\n"); ++failures; break; } } printf("Checking dsk_option_enum\n"); e = dsk_option_enum(outdr, 0, &optname); CHECKERR("dsk_option_enum") else { printf("-- first option is %s\n", optname); } if (!optname) optname = "dummy"; printf("Checking dsk_get_option(%s)\n", optname); e = dsk_get_option(outdr, optname, &value); CHECKERR2("dsk_get_option") else { printf("-- value=%d\n", value); } printf("Checking dsk_set_option(example, 2)\n"); e = dsk_set_option(outdr, "example", 2); CHECKERR2("dsk_set_option") printf("Checking dsk_rtread\n"); e = dsk_rtread(outdr, &dg, trkbuf, 0, 0, 0); CHECKERR3("dsk_rtread") printf("Checking dsk_get_comment\n"); e = dsk_get_comment(outdr, &comment); CHECKERR3("dsk_get_comment") else if (comment) printf("-- comment=%s\n", comment); } if (outdr) { dsk_close(&outdr); CHECKERR("dsk_close") } printf("\n"); printf("Failed calls (failure important): %2d\n", failures); printf("Failed calls (failure unimportant): %2d\n", warnings); printf("Unimplemented functions: %2d\n", unimpl); printf("Unimplemented functions over RPC: %2d\n", rpcunimp); return failures; }