Fixed all behavior. Robot is now working as intended.