Firmware changes:
1. Added depth sensor reading
2. Changed pins for manipulator
Set converting function for Honeywell depth sensor