Adds a function to stretch or compress a polynomial in time.
Uses this new function in the trajectory, which means any trajectory can be scaled to meet constraints. Before would still solve linearly to get new coefficients, which means couldn't use this in loco.
Changes nlopt to change this implementation instead.
Changes: