Create RoutePlanManager.h

just finish logic codes, not test