revised TrapezoidalMotion() and fixed the test issues.  closes #32