Fixed little bugs in teleop_key