Fixed error in pressure function.

This is for #21. This function needs to return p and not p_reference.