Refactor changes on rox driver

[altex111]

• [x] Torque states handling
• [x] scheduler setup move to robot control node
• [x] Hardware interface write function: changes to make it more cleen
• [x] After failed activation the robot manager node should set to configured state not unconfigured
• [x] #65