Update inertia matrix for UR3e and UR5e from measurements (backport of #256) (#274)

Author: mergify[bot]

config/ur3e/physical_parameters.yaml

@@ -51,74 +51,72 @@ inertia_parameters:
       y: 0.0        # model.y
       z: -0.02      # model.z
 
-  # compatible with cylinder approximation
   rotation:
     shoulder:
-      roll: 0
+      roll: 1.570796326794897
       pitch: 0
       yaw: 0
     upper_arm:
       roll: 0
-      pitch: 1.570796326794897
+      pitch: 0
       yaw: 0
     forearm:
       roll: 0
-      pitch: 1.570796326794897
+      pitch: 0
       yaw: 0
     wrist_1:
-      roll: 0
+      roll: 1.570796326794897
       pitch: 0
       yaw: 0
     wrist_2:
-      roll: 0
+      roll: -1.570796326794897
       pitch: 0
       yaw: 0
     wrist_3:
       roll: 0
       pitch: 0
       yaw: 0
 
-  # generated using cylinder approximation
   tensor:
     shoulder:
-      ixx: 0.008093166666666665
-      ixy: 0
-      ixz: 0
-      iyy: 0.008093166666666665
-      iyz: 0
-      izz: 0.005625
+      ixx: 0.002767
+      ixy: 0.000010
+      ixz: -0.000015
+      iyy: 0.002150
+      iyz: 0.000187
+      izz: 0.002564
     upper_arm:
-      ixx: 0.021728491912499998
-      ixy: 0
-      ixz: 0
-      iyy: 0.021728491912499998
-      iyz: 0
-      izz: 0.00961875
+      ixx: 0.004268
+      ixy: -0.000041
+      ixz: -0.001508
+      iyy: 0.046079
+      iyz: -0.000013
+      izz: 0.044943
     forearm:
-      ixx: 0.006544570199999999
+      ixx: 0.001089
       ixy: 0
-      ixz: 0
-      iyy: 0.006544570199999999
-      iyz: 0
-      izz: 0.00354375
+      ixz: -0.000009
+      iyy: 0.011485
+      iyz: 0.000002
+      izz: 0.011204
     wrist_1:
-      ixx: 0.0020849999999999996
-      ixy: 0
-      ixz: 0
-      iyy: 0.0020849999999999996
-      iyz: 0
-      izz: 0.00225
+      ixx: 0.001008
+      ixy: -0.000001
+      ixz: 0.000001
+      iyy: 0.000822
+      iyz: 0.000133
+      izz: 0.000603
     wrist_2:
-      ixx: 0.0020849999999999996
-      ixy: 0
-      ixz: 0
-      iyy: 0.0020849999999999996
-      iyz: 0
-      izz: 0.00225
+      ixx: 0.000641
+      ixy: -0.000001
+      ixz: 0.000002
+      iyy: 0.000619
+      iyz: -0.000026
+      izz: 0.000386
     wrist_3:
-      ixx: 0.00013626666666666665
-      ixy: 0
-      ixz: 0
-      iyy: 0.00013626666666666665
-      iyz: 0
-      izz: 0.0001792
+      ixx: 0.000548
+      ixy: 0.000002
+      ixz: -0.000002
+      iyy: 0.000274
+      iyz: -0.000197
+      izz: 0.000412

config/ur5e/physical_parameters.yaml

@@ -51,74 +51,72 @@ inertia_parameters:
       y: 0.0        # model.y
       z: -0.001159  # model.z
 
-  # compatible with cylinder approximation
   rotation:
     shoulder:
-      roll: 0
+      roll: 1.570796326794897
       pitch: 0
       yaw: 0
     upper_arm:
       roll: 0
-      pitch: 1.570796326794897
+      pitch: 0
       yaw: 0
     forearm:
       roll: 0
-      pitch: 1.570796326794897
+      pitch: 0
       yaw: 0
     wrist_1:
-      roll: 0
+      roll: 1.570796326794897
       pitch: 0
       yaw: 0
     wrist_2:
-      roll: 0
+      roll: -1.570796326794897
       pitch: 0
       yaw: 0
     wrist_3:
       roll: 0
       pitch: 0
       yaw: 0
 
-  # generated using cylinder approximation
   tensor:
     shoulder:
-      ixx: 0.010267499999999999
-      ixy: 0
-      ixz: 0
-      iyy: 0.010267499999999999
-      iyz: 0
-      izz: 0.00666
+      ixx: 0.00700210
+      ixy: 0.00000073
+      ixz: -0.00001053
+      iyy: 0.00648091
+      iyz: 0.00049994
+      izz: 0.00657286
     upper_arm:
-      ixx: 0.13388583541666665
-      ixy: 0
-      ixz: 0
-      iyy: 0.13388583541666665
-      iyz: 0
-      izz: 0.0151074
+      ixx: 0.01505885
+      ixy: -0.00005400
+      ixz: 0.00000563
+      iyy: 0.33388086
+      iyz: -0.00000181
+      izz: 0.33247207
     forearm:
-      ixx: 0.03120936758333333
-      ixy: 0
-      ixz: 0
-      iyy: 0.03120936758333333
-      iyz: 0
-      izz: 0.004095
+      ixx: 0.00399632
+      ixy: -0.00001365
+      ixz: 0.00137272
+      iyy: 0.07879254
+      iyz: -0.00000660
+      izz: 0.07848510
     wrist_1:
-      ixx: 0.0025599
-      ixy: 0
-      ixz: 0
-      iyy: 0.0025599
-      iyz: 0
-      izz: 0.0021942
+      ixx: 0.00165491
+      ixy: -0.00000282
+      ixz: -0.00000438
+      iyy: 0.00135962
+      iyz: 0.00010157
+      izz: 0.00126279
     wrist_2:
-      ixx: 0.0025599
-      ixy: 0
-      ixz: 0
-      iyy: 0.0025599
-      iyz: 0
-      izz: 0.0021942
+      ixx: 0.00135617
+      ixy: -0.00000274
+      ixz: 0.00000444
+      iyy: 0.00127827
+      iyz: -0.00005048
+      izz: 0.00096614
     wrist_3:
-      ixx: 9.890414008333333e-05
-      ixy: 0
-      ixz: 0
-      iyy: 9.890414008333333e-05
-      iyz: 0
-      izz: 0.0001321171875
+      ixx: 0.00018694
+      ixy: 0.00000006
+      ixz: -0.00000017
+      iyy: 0.00018908
+      iyz: -0.00000092
+      izz: 0.00025756