Rename/refactor fps moveToSafePosition

The fps moveToSafePosition accepts both phi= and theta= arguments, which lets you use it as a converged moveToThetaPhi command. We should probably pull that out or refactor it, and accept the usual iteration/tolerance/etc arguments.

There is also a moveToPhiAngle, which can probably be rolled in.