From 79a8c06cd5f5f8d6ad887a5ca71d4464523a43e1 Mon Sep 17 00:00:00 2001 From: Christian Pointner Date: Tue, 20 May 2014 04:02:33 +0200 Subject: added set speed in rpm --- tube-rotator/stepper.c | 9 +++++++-- 1 file changed, 7 insertions(+), 2 deletions(-) (limited to 'tube-rotator/stepper.c') diff --git a/tube-rotator/stepper.c b/tube-rotator/stepper.c index 84bd666..3a08cd4 100644 --- a/tube-rotator/stepper.c +++ b/tube-rotator/stepper.c @@ -132,7 +132,12 @@ uint16_t stepper_get_speed(void) return target_speed; } -uint16_t stepper_get_speed_rpm(void) +void stepper_set_speed_rpm(uint8_t new_rpm) { - return (uint16_t)lround( ( (double)F_CPU / (double)(64.0 * 800.0 * (double)(target_speed + 1) ) ) * 60.0 ); + stepper_set_speed(( (uint16_t)( (double)(60.0 * F_CPU) / (double)(64.0 * 800.0 * (double)new_rpm) ) ) - 1); +} + +uint8_t stepper_get_speed_rpm(void) +{ + return (uint8_t)lround( ( (double)F_CPU / (double)(64.0 * 800.0 * (double)(target_speed + 1) ) ) * 60.0 ); } -- cgit v1.2.3