Remove init_node from actuator handler.
Protect against stopping motion twice.
Fix actuator handler init and sweep.