Check if command exceeds opening limits also for single side controller.

Also, error fixed for the trapezoidal controller