added base_link transform to odom calculation, some refactoring
fixed visualization of higher level keypoints
Merge branch 'viz_fix' into develop
Merge branch 'tf_fix' into develop
Merge branch 'develop'