From 4a6338257aa73a9a4f47f40195be7bf747c8c529 Mon Sep 17 00:00:00 2001 From: rusefi Date: Sat, 17 Mar 2018 21:51:46 -0400 Subject: [PATCH] #569 --- firmware/hw_layer/servo.cpp | 7 +++++-- 1 file changed, 5 insertions(+), 2 deletions(-) diff --git a/firmware/hw_layer/servo.cpp b/firmware/hw_layer/servo.cpp index d297eaa0d2..fd25facd93 100644 --- a/firmware/hw_layer/servo.cpp +++ b/firmware/hw_layer/servo.cpp @@ -51,9 +51,12 @@ static msg_t seThread(void *arg) { while (true) { pin.setValue(1); - percent_t position = 10 * (getTimeNowSeconds() % 11); // 0, 10, .., 90, 100 - float durationMs = 1 + position * 0.01f; + percent_t position = (currentTimeMillis() / 5) % 200; + if (position > 100) + position = 200 - position; + + float durationMs = 0 + position * 0.02f; scheduleForLater(&servoTurnSignalOff, (int)MS2US(durationMs), (schfunc_t) &servoTachPinLow, NULL);