Add command status
TODO @spatkar1
- Add publishers on the hardware side about command completion status
- Add subscribers in generic arm to receive the command completion status and forward it using getCommandStatus function
- Add publisher on the hardware for the health of the arm
- Add subscribers in generic arm to receive the health and specify the state variable to correct enum values
- Test these functionalities using the examples written.