create helpers for geometric calculations

We currently have some functions in `plot_scanner.py` to do rigid transformations etc. Those should be in `__init__.py`, i.e. available after `import helpers`. They should also be in the C++ code.