Implemented beluga command subscriber in estimator
Implemented depth handling for beluga estimator