Lab5: Warmup3 minus trapezoidalRefControl