Remove unused functions.
FMS initial version.
Use Speed and Length wherever possible.