Simplifiy, comment, and bug fix errors in the tele-op.