read.py 4.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135
  1. # greaseweazle/tools/read.py
  2. #
  3. # Greaseweazle control script: Read Disk to Image.
  4. #
  5. # Written & released by Keir Fraser <keir.xen@gmail.com>
  6. #
  7. # This is free and unencumbered software released into the public domain.
  8. # See the file COPYING for more details, or visit <http://unlicense.org>.
  9. description = "Read a disk to the specified image file."
  10. import sys
  11. import importlib
  12. from greaseweazle.tools import util
  13. from greaseweazle import error
  14. from greaseweazle import usb as USB
  15. from greaseweazle.flux import Flux
  16. def open_image(args):
  17. image_class = util.get_image_class(args.file)
  18. error.check(hasattr(image_class, 'to_file'),
  19. "%s: Cannot create %s image files"
  20. % (args.file, image_class.__name__))
  21. image = image_class.to_file(args.scyl, args.nr_sides)
  22. if args.rate is not None:
  23. image.bitrate = args.rate
  24. for opt, val in args.file_opts.items():
  25. error.check(hasattr(image, 'opts') and hasattr(image.opts, opt),
  26. "%s: Invalid file option: %s" % (args.file, opt))
  27. setattr(image.opts, opt, val)
  28. return image
  29. def normalise_rpm(flux, rpm):
  30. """Adjust all revolutions in Flux object to have specified rotation speed.
  31. """
  32. index_list, freq = flux.index_list, flux.sample_freq
  33. norm_to_index = 60/rpm * flux.sample_freq
  34. norm_flux = []
  35. to_index, index_list = index_list[0], index_list[1:]
  36. factor = norm_to_index / to_index
  37. for x in flux.list:
  38. to_index -= x
  39. if to_index >= 0:
  40. norm_flux.append(x*factor)
  41. continue
  42. if not index_list:
  43. break
  44. n_to_index, index_list = index_list[0], index_list[1:]
  45. n_factor = norm_to_index / n_to_index
  46. norm_flux.append((x+to_index)*factor - to_index*n_factor)
  47. to_index, factor = n_to_index, n_factor
  48. return Flux([norm_to_index]*len(flux.index_list), norm_flux, freq)
  49. def read_to_image(usb, args, image, decoder=None):
  50. """Reads a floppy disk and dumps it into a new image file.
  51. """
  52. for cyl in range(args.scyl, args.ecyl+1):
  53. for side in range(0, args.nr_sides):
  54. print("\rReading Track %u.%u..." % (cyl, side), end="")
  55. usb.seek((cyl, cyl*2)[args.double_step], side)
  56. flux = usb.read_track(args.revs)
  57. if args.rpm is not None:
  58. flux = normalise_rpm(flux, args.rpm)
  59. dat = flux if decoder is None else decoder(cyl, side, flux)
  60. image.append_track(dat)
  61. print()
  62. # Write the image file.
  63. with open(args.file, "wb") as f:
  64. f.write(image.get_image())
  65. def main(argv):
  66. parser = util.ArgumentParser(usage='%(prog)s [options] file')
  67. parser.add_argument("--device", help="greaseweazle device name")
  68. parser.add_argument("--drive", type=util.drive_letter, default='A',
  69. help="drive to read (A,B,0,1,2)")
  70. parser.add_argument("--format", help="disk format")
  71. parser.add_argument("--revs", type=int, default=3,
  72. help="number of revolutions to read per track")
  73. parser.add_argument("--scyl", type=int, default=0,
  74. help="first cylinder to read")
  75. parser.add_argument("--ecyl", type=int, default=81,
  76. help="last cylinder to read")
  77. parser.add_argument("--single-sided", action="store_true",
  78. help="single-sided read")
  79. parser.add_argument("--double-step", action="store_true",
  80. help="double-step drive heads")
  81. parser.add_argument("--rate", type=int, help="data rate (kbit/s)")
  82. parser.add_argument("--rpm", type=int, help="convert drive speed to RPM")
  83. parser.add_argument("file", help="output filename")
  84. parser.description = description
  85. parser.prog += ' ' + argv[1]
  86. args = parser.parse_args(argv[2:])
  87. args.nr_sides = 1 if args.single_sided else 2
  88. args.file, args.file_opts = util.split_opts(args.file)
  89. try:
  90. usb = util.usb_open(args.device)
  91. image = open_image(args)
  92. if not args.format and hasattr(image, 'default_format'):
  93. args.format = image.default_format
  94. decoder = None
  95. if args.format:
  96. mod = importlib.import_module('greaseweazle.codec.' + args.format)
  97. decoder = mod.__dict__['decode_track']
  98. try:
  99. util.with_drive_selected(read_to_image, usb, args, image,
  100. decoder=decoder)
  101. except:
  102. print()
  103. raise
  104. except USB.CmdError as error:
  105. print("Command Failed: %s" % error)
  106. if __name__ == "__main__":
  107. main(sys.argv)
  108. # Local variables:
  109. # python-indent: 4
  110. # End: