Servo control for the pen

[maximius]

Good afternoon, Bart.
Thank you very much for your work. I want to build a Drawing Robot (CoreXY mechanics), based on your controller. But there was one question about working with servo.

I use the GRBL v1.3a firmware. Configuration of pen_laser. h. I configured the laser control successfully(on the PWM pin with a frequency of 5 kHz, the duty cycle changes when the parameter S changes within 0-255)

When I select #define USE_PEN_SERVO in config.h. in the configuration, the pulse frequency on the PWM pin becomes 50 Hz (pulse length 2ms), but when changing the position of the servo (for example, m3 s10 or m3 s20), the pulse length does not change. and the pulses start to be generated only when the axes are moved. I tried different configurations and settings, but I didn't learn how to change the position of the servo.
I ask for help in this matter. How to properly control the servo to move the handle?
While using RBL_Servo on the arduino Uno and to control the servo, the commands m3 s3 for moving down and m5 for lifting the handle are used.