simple_tps preservation
Merge branch 'topo' of https://github.com/ttblue/human_demos into topo
stabilization points projected onto table