Contextual information aided target tracking and path planning for autonomous ground vehicles