Remove unneeded imports
Convert DriveToPose to ExecuteVFHMove
Use ExecuteVFHMove for line moves
Modify simple move states for new server