Fixed Bugs

teleop, logic, timed tasks