Costmap obstacle timeout

clearing obstacles from cost map after a timeout feature tested and code cleaned up. Need to look over it, maybe add feature for clearing obstacles from local map as well and put everything into one commit.