Add unit tests

[eve70a]

Current testing is based primarily on full test-cases. Additional unit testing may be developed for crucial parts of the code, like splines and contact search.