Write more/better tests

There is a high need of writing better tests for existing functionality, possibly using problems and solutions available from the literature. Currently tests mostly verify basic functionality and are probably not very indicative of the library correctness.
