Correct callback mechanism.

Robot is turned off when plotting point or executing all steps. If it
was on, it's turned back on immediatly after.