Update teleop.c

Changed latch1 to latch, added belt_move and arm_move