Fork of http://robotics.ccny.cuny.edu/git/ccny-ros-pkg/ccny_vision.git with some fixes