Added second head support

Added the ability to write to all heads and to all sectors.