From 31686afee01d0fa0c94307897b8f7a33b2cf2244 Mon Sep 17 00:00:00 2001
From: Christian Pointner <equinox@spreadspace.org>
Date: Tue, 20 May 2014 03:13:40 +0200
Subject: added conversion from speed value to rpm

---
 tube-rotator/stepper.c | 6 ++++++
 1 file changed, 6 insertions(+)

(limited to 'tube-rotator/stepper.c')

diff --git a/tube-rotator/stepper.c b/tube-rotator/stepper.c
index 064db5a..a498b43 100644
--- a/tube-rotator/stepper.c
+++ b/tube-rotator/stepper.c
@@ -23,6 +23,7 @@
 #include <avr/sfr_defs.h>
 #include <avr/interrupt.h>
 #include <util/atomic.h>
+#include <math.h>
 
 #include "stepper.h"
 
@@ -125,3 +126,8 @@ uint16_t stepper_get_speed(void)
 {
   return target_speed;
 }
+
+uint8_t stepper_get_speed_rpm(void)
+{
+  return (uint8_t)lround( ( (double)F_CPU / (double)(51200 * (target_speed + 1) ) ) * 60.0 );
+}
-- 
cgit v1.2.3