Theta * path planner in 2D grid map，and show path with OpenCV.
The implementation of the algorithm was checked out from: https://github.com/lapinozz/Lazy-Theta-with-optimization-any-angle-pathfinding
I rewrote some statements to fit vs 2013
