Made changes to test code on robot

Problems: Might be the Jaguar's issue, might be the code issue, might be
limit switch