minor updates
bug fixes after testing on robot
included phase stopping (already tested