Marlin регулировка PWM

Друзья всем привет, вопрос такой по Marline , имеется PIN 5 при включении платы на пине 5V.

Пин использую для включение лазера командой M3 и выключением M5 соотвественно. , при включении M3 напряжение падает до 2V что есть нормально и лазер вкл и выкл.

НО когда я включаю по M3 S5 ( то есть включить на 5% мощности ) то лазер включается на 95% ( сразу напряжение падает до 3V, когда я даю команду включить на M3 S95 лазер включается на 5% мощности ) напряжение на пине падает на +- 0.30V .

Кто может подсказать где этот параметр можно посмотреть и инвертировать? так что бы по командам правильно происходила регулировка ?

Есть laser.cpp но из за не хватки знания не могу правильно отредактировать , пробовал играться с данным кодом но лазер то включался не регулировался по мощности то не включался во все.

void laser_fire(int intensity = 100.0){

laser.firing = LASER_ON;

laser.last_firing = micros(); // microseconds of last laser firing

if (intensity > 100.0) intensity = 100.0; // restrict intensity between 0 and 100

if (intensity < 0) intensity = 0;

pinMode(LASER_FIRING_PIN, OUTPUT);

#if LASER_CONTROL == 1

analogWrite(LASER_FIRING_PIN, labs((intensity / 100.0)*(F_CPU / LASER_PWM)));

#endif

#if LASER_CONTROL == 2

analogWrite(LASER_INTENSITY_PIN, labs((intensity / 100.0)*(F_CPU / LASER_PWM)));

digitalWrite(LASER_FIRING_PIN, LASER_ARM);

#endif

if (laser.diagnostics) {

SERIAL_ECHOLN('Laser fired');

}

}

Лазер контроль работает на 1

Кто подскажет и направит на истинный путь =)