teleop.py: in _cleanup(), disable robot first

Sometimes the robot failed to stop as the ros have already
unsubscribed from topics.
teleop.py: Move robot enabling code into _enable()
teleop.py: remove self.enabled, redundant
teleop.py: show dead face in case physical e-stop is engaged