fixed a couple things in trapezoid
fixed a couple bugs in motion control stuff