sornpraram xu / RMD

RMD-X Motor Library - Last Update V0.5 - On going...... Current available Function - read velocity - read all data - send velocity - send position

Diff: RMD.cpp

Revision:
9:defd39d3fdf1
Parent:
8:82b39d6566c2
Child:
10:5221a88e2240
--- a/RMD.cpp	Wed Nov 04 10:09:10 2020 +0000
+++ b/RMD.cpp	Wed Nov 04 10:12:28 2020 +0000
@@ -26,7 +26,7 @@
 void RMD::status_position(){
     if (read(msg)){
 
-        int fv = (((uint16_t)msg.data[7] << 8) + ((uint16_t)msg.data[6])) / ((uint16_t)6);
+        int fv = (((uint16_t)msg.data[7] << 8) + ((uint16_t)msg.data[6]));
         
         printf(" Position : %d\n", fv);
         printf(" Position high byte: %x\n", msg.data[7]);