integrate opencv into costmap layer