Fix some bugs. Add value center of AUV for buoyant force. Add dvl message