SYSTEM AND METHOD FOR PATH PLANNING

A method for mapping a motion of a first object within a first motion path defined by a path planner based on a second motion path of a second object. The method includes creating the first motion path for the first object using the path planner, initializing a start position of the first object within the first motion path, determining a value for an initial condition for each segment of a plurality of segments in the first motion path created by the path planner, and calculating an elapsed time between a current sample call time to the path planner and a last sample call time to the path planner. If the calculated elapsed time is one of greater than and less than a sample period, a current location of the second object in the second motion path is determined utilizing the calculated elapsed time, an expired time within a first segment of the plurality if segments between a start time of the first segment and the current sample call time is calculated, and an output command is generated from the path planner. Execution of the generated output command alters the first motion path.