generateTrapezoidal

fun generateTrapezoidal(    startState: MotionState,     endState: MotionState,     constraints: MotionConstraints): MotionProfile