Fix FPU initialization code