Trapezoidal accel working.. Tinyg port started