Implemented LBA to CHS

Implemented lba2chs function in preparation for reading from floppy
drive