format code

Signed-off-by: Jan Losinski <losinski@wh2.tu-dresden.de>
Hack the whole algorithm into c++

Signed-off-by: Jan Losinski <losinski@wh2.tu-dresden.de>
Adjust python bindings

Signed-off-by: Jan Losinski <losinski@wh2.tu-dresden.de>
Refactor integration test to use the new algorithm

Signed-off-by: Jan Losinski <losinski@wh2.tu-dresden.de>