extend rbt to rotation and translation of multiple rigid bodies
add tests for static methods
fully functional tunneler