Trimmed servo. Moved ramp speed calculation to speed function. Properly maps negative speed values in monitor.