@@ -581,7 +581,7 @@ def set_servo_data(self, servo_id, data_id, value, mode=None):
581581 self .calibration_parameters (class_name = self .__class__ .__name__ , id = servo_id , address = data_id , value = value , mode = mode )
582582 return self ._mesg (ProtocolCode .SET_SERVO_DATA , servo_id , data_id , [value ], mode )
583583
584- def get_servo_data (self , servo_id , data_id ):
584+ def get_servo_data (self , servo_id , data_id , mode = None ):
585585 """Read the data parameter of the specified address of the steering gear.
586586
587587 Args:
@@ -590,10 +590,16 @@ def get_servo_data(self, servo_id, data_id):
590590 for mypalletizer: Joint id 1 - 4
591591 for myArm: joint id 1 - 7
592592 data_id: Data address.
593+ mode: 0 - indicates that value is one byte(default), 1 - 1 represents a value of two bytes.
593594
594595 Return:
595596 values 0 - 4096
596597 """
598+ if mode is not None :
599+ self .calibration_parameters (class_name = self .__class__ .__name__ , id = servo_id , address = data_id )
600+ return self ._mesg (
601+ ProtocolCode .GET_SERVO_DATA , servo_id , data_id , has_reply = True
602+ )
597603 self .calibration_parameters (class_name = self .__class__ .__name__ , id = servo_id , address = data_id )
598604 return self ._mesg (
599605 ProtocolCode .GET_SERVO_DATA , servo_id , data_id , has_reply = True
0 commit comments