The bayes tracker is now publishing a people_msgs/People message which can be used for the social navigation layer.
The orientation of the person has been added to all published messages that allow for orientation information. The visualisation has not been adapted yet, but showing a Pose of the closest person in rviz, shows that the orientation is now correctly calculated. Know issues: for standing people the orientation is not well defined.
All of this has only been tested in simulation so far.
Closes #143, #38
people_msgs/Peoplemessage which can be used for the social navigation layer.All of this has only been tested in simulation so far.