Simple simulator-like test program added.

So far it only computes a single pressure solution.
Removed unused variables sw and so.