code to transform person positions to robot positions and publish, not tested, should be on a branhc, yes I'm sorry
Merge branch 'master' of https://github.com/Brooks-Willis/dance_bot