Added TrapezoidStepper and tests for it