depth_rate returns positive vertical speed when going "down" on a dive.
Negative pitch angle occurs during dive descent.
This results in a NEGATIVE "forward velocity" from speed_from_depth" during descents and ascents. (Probably we need to change some of the directionality conventions or flip sign of forward speed output?)