Fix head nod

There was a nonsensical second waitfor statement in the command head nod function, that only worked if we just caught the instant between the motor stopping and publishing.