Cleanup unittests and make more easy to run (cleanup other parts of repo too)

[sean-engelstad]

• cleanup unittests
• make unittests able to run in python with pybind11 maybe
• cleanup other parts of code like examples too (more readable and easier to use, maybe add pybind11 to each of them)