Added a function that returns the distance from the whale's belly to the waterlevel.
The whale can now dive when in air.
Merge branch 'development' of https://github.com/DadiuTeamOne/Blue into development