Fix pressure to depth conversion

Current pressure to depth conversion is a bit of a hack and should be improved.