Rejecting arming if safety switch is not in safe position, added reboot command