added FPU saving/restoring support

The new FPU commit for master branch.
Some indention problems there because old use tabs instead of spaces.