From 981c7a3ae771535bee85f328017bdd94ae6232bc Mon Sep 17 00:00:00 2001
From: mrunaljsarvaiya <mrunaljsarvaiya@gmail.com>
Date: Wed, 30 Sep 2020 13:29:27 -0700
Subject: [PATCH] Cast pos to double

---
 src/dynamixel/servos/servo.hpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/dynamixel/servos/servo.hpp b/src/dynamixel/servos/servo.hpp
index f07b94f7..77ce023c 100644
--- a/src/dynamixel/servos/servo.hpp
+++ b/src/dynamixel/servos/servo.hpp
@@ -195,7 +195,7 @@ namespace dynamixel {
             {
                 typename Servo<Model>::ct_t::present_position_t pos;
                 Servo<Model>::protocol_t::unpack_data(st.parameters(), pos);
-                double deg = ((pos - ct_t::min_goal_position) * (ct_t::max_goal_angle_deg - ct_t::min_goal_angle_deg) / (ct_t::max_goal_position - ct_t::min_goal_position)) + ct_t::min_goal_angle_deg;
+                double deg = (((double)pos - ct_t::min_goal_position) * (ct_t::max_goal_angle_deg - ct_t::min_goal_angle_deg) / (ct_t::max_goal_position - ct_t::min_goal_position)) + ct_t::min_goal_angle_deg;
                 double rad = deg / 57.2958;
                 return rad;
             }