RobotarmSensorWatchdog.java and RobotarmImpl.java modified, hopefully it works, testing it @ Monday