Maybe this source code XT PC help to resolve problem:
http://xtideuniversalbios.googlecode.com/svn/trunk/XTIDE_Universal_BIOS/Src/Initialization/FloppyDrive.asm