Create roadmidpoint.cpp

ROS(Hydro) ported code for midpointed detection on a road.