private DubinInput dubinInput(DubinNode near, DubinNode target)
 {
     return(DubinUtils.DubinSP(new DubinState(near), new DubinState(target), true));
 }