Update OptimalMotionPlanner.h

case typo