reworked TrapezoidalMotion a bit and improved test cases
more trapezoid tests