Fifth commit

working/ final Teleop.  no autonomous, shooting program is working fine