SBP: Adding utils functions for ECEF velocity and position.