Tweak or customize cost around people on the costmap
Hello,
I want to tweak or customize the costmap my turtlebot generates such that it assigns higher costs to the cells ahead of a moving person, based on his direction of motion. That is, I want it to predict where the person will be in the next few seconds in order to more intelligently perform its path-planning.
I will be using the PCL People Detection Code to first of all detect and recognize that an 'object' is a person. I will be using the costmap_2d and gmapping packages for the costmap generation. So once I combine these two, I assume it's just a matter of detecting the direction of motion and then knowing which cells' costs to elevate.
Any thoughts on how to do this? How do I detect direction of motion? How do I track motion of ONLY 'people objects'? How do I customize and choose which cells to elevate costs?
Thanks.