Added debug statements for determining direction of articulation
Added debug statements for determining direction of articulation

MarsRobotics/ROSta-Bot,MarsRobotics/ROSta-Bot,MarsRobotics/ROSta-Bot,MarsRobotics/ROSta-Bot