Fix validation bug in RobotStatus Topic
Add power status check on init
Fix bug with handleStatus. Add validation for location, waypoint handlers