When I try to execute kind of below code with roseus command, it become segmentation f

The diff results were as below. Original is the output when mo

<a class="user-mention notranslate" data-hovercard-type="user" data-hovercard-url="/us

/tmp/irtmodel-ik failuer file will become segmentation fault when I execute with roseus,about jsk-ros-pkg/jsk_roseus

Comments (9)

k-okada commented on June 12, 2024

please remove :additional-weight-list ((#<bodyset-link #Xe6e4df0 torso_lift_link ...)) from pr2-sensor-robot-2014-07-12-17-44-47-failure.l and see if this works.

from jsk_roseus.

aginika commented on June 12, 2024

Removing surpress the segmentation fault! Thanks.

from jsk_roseus.

k-okada commented on June 12, 2024

ok, it is not end, we just find starting point ;-)

the problem is #<bodyset-link #Xe6e4df0 torso_lift_link ... is the pointer to the object and #X.. is the memory location so that is not valid once you restart the euslisp environment.

so please check

if you just remove :additional-wait-list .. then it produces different solution
replace #<body-link .... torso_lift_link> with something like (send r :torso_lift_link) then it generate same solution.

from jsk_roseus.

aginika commented on June 12, 2024

Hmm... I couldn't understand what should I do...

I did 1) at previous my comment. but what is "different solution" you meand and what to check?

At this time , I replase #<body> with (send r :torso_lift_link) and this suppress the segmentation too..

from jsk_roseus.

k-okada commented on June 12, 2024

I did 1) at previous my comment. but what is "different solution" you meand and what to check?

when pr2-sensor-robot-2014-07-12-17-44-47-failure.l is produced you saw some error message (ik-failed...) and you can see how close the end-coords at the end of iteration in distance in xyz and rpy (dif-pos and dif-rot in [1]).

and if you remove :additional-weight-list and execute "-filufre.l" then you will see ik fail error message with different distance or it may success, because it uses different ik parameters than when euslisp generated "-failure.l" generated.

[1] https://github.com/euslisp/jskeus/blob/master/irteus/irtmodel.l#L2034

from jsk_roseus.

aginika commented on June 12, 2024

OK. I may understand.
Finally I will need compare the dif-pos and dif-rot among message which is in terminal , message which is produced by removed program and message which is produced by replaced program.

BTW, I get some error when I did ik_setup and ik_check, so I will open new issue.
After that is cleared, I will check this issue.

from jsk_roseus.

aginika commented on June 12, 2024

The diff results were as below.

Original is the output when motion file is played.
Remove additional is the output when remove :additional-weight-list.
Repair additional is the output when replace #<bodyset-link with (send r :torso_lift_link_lk).

2.and 3. was same, so the replace didn't seem to affect.

Below is Summary

;;original result=================================
;;ik-failed
;;((:dif-pos #f(-30.7121 -6.19955 -7.29337)) (:dif-rot #f(-0.009168 -0.004614 0.043459)))
dif-pos #f(-30.7121 -6.19955 -7.29337)
dif-rot #f(-0.009168 -0.004614 0.043459)

;;remove additional=================================
;; inverse-kinematics failed.
dif-pos : #f(-30.7084 -6.19854 -7.2926)/(32.1653/10)
dif-rot : #f(-0.009167 -0.004614 0.043453)/(0.044649/0.087266)


;;repair additional=================================    
dif-pos : #f(-30.7084 -6.19854 -7.2926)/(32.1653/10)
dif-rot : #f(-0.009167 -0.004614 0.043453)/(0.044649/0.087266)

Below is detail output

Original

;; inverse-kinematics failed.
;; dif-pos : #f(-30.7121 -6.19955 -7.29337)/(32.1692/10)
;; dif-rot : #f(-0.009168 -0.004614 0.043459)/(0.044654/0.087266)
;;  coords : #<coordinates #Xbf31ba0  3326.358 1349.163 -0.854 / 1.544 0.004 0.002>
;;  angles : (50.0 110.0 74.0 70.0 -120.0 20.0 -30.0 180.0 -15.5326 32.7327 -79.4761 -121.542 -179.057 -106.754 250.856 -1.12702 58.7871)
;;    args : ((#<coordinates #Xe6d3c20  3351.999 1805.369 684.995 / 1.571 0.524 -1.829e-06>) :move-target #<cascaded-coords #Xe34c110 :rarm-end-coords  3347.207 1835.803 675.74 / 1.521 0.528 -0.016> :link-list (#<bodyset-link #Xe0cfd70 r_shoulder_pan_link_lk  3514.721 1297.459 839.637 / 1.293 0.004 0.001> #<bodyset-link #Xe130fd0 r_shoulder_lift_link_lk  3542.142 1393.625 839.199 / 1.293 0.32 0.001> #<bodyset-link #Xe19a738 r_upper_arm_roll_link_lk  3542.142 1393.625 839.199 / 1.293 0.32 -1.57> #<bodyset-link #Xe048ee8 r_elbow_flex_link_lk  3646.142 1758.79 713.349 / -2.892 -0.166 -1.296> #<bodyset-link #Xe096000 r_forearm_roll_link_lk  3646.142 1758.79 713.349 / -2.892 -0.166 2.074> #<bodyset-link #Xdf13ce8 r_wrist_flex_link_lk  3339.39 1680.5 766.404 / 1.521 0.528 1.566> #<bodyset-link #Xdf5fa20 r_wrist_roll_link_lk  3339.39 1680.5 766.404 / 1.521 0.528 -0.016>) :rthre 0.087266 :thre 10 :stop 300 :additional-weight-list ((#<bodyset-link #Xe266e18 torso_lift_link_lk  3326.789 1302.498 840.013 / 1.544 0.004 0.002> 0.005)) :link-list (#<bodyset-link #Xe0cfd70 r_shoulder_pan_link_lk  3514.721 1297.459 839.637 / 1.293 0.004 0.001> #<bodyset-link #Xe130fd0 r_shoulder_lift_link_lk  3542.142 1393.625 839.199 / 1.293 0.32 0.001> #<bodyset-link #Xe19a738 r_upper_arm_roll_link_lk  3542.142 1393.625 839.199 / 1.293 0.32 -1.57> #<bodyset-link #Xe048ee8 r_elbow_flex_link_lk  3646.142 1758.79 713.349 / -2.892 -0.166 -1.296> #<bodyset-link #Xe096000 r_forearm_roll_link_lk  3646.142 1758.79 713.349 / -2.892 -0.166 2.074> #<bodyset-link #Xdf13ce8 r_wrist_flex_link_lk  3339.39 1680.5 766.404 / 1.521 0.528 1.566> #<bodyset-link #Xdf5fa20 r_wrist_roll_link_lk  3339.39 1680.5 766.404 / 1.521 0.528 -0.016>) :move-target #<cascaded-coords #Xe34c110 :rarm-end-coords  3347.207 1835.803 675.74 / 1.521 0.528 -0.016> :move-target #<cascaded-coords #Xe34c110 :rarm-end-coords  3347.207 1835.803 675.74 / 1.521 0.528 -0.016> :collision-avoidance-link-pair nil :link-list (#<bodyset-link #Xe0cfd70 r_shoulder_pan_link_lk  3514.721 1297.459 839.637 / 1.293 0.004 0.001> #<bodyset-link #Xe130fd0 r_shoulder_lift_link_lk  3542.142 1393.625 839.199 / 1.293 0.32 0.001> #<bodyset-link #Xe19a738 r_upper_arm_roll_link_lk  3542.142 1393.625 839.199 / 1.293 0.32 -1.57> #<bodyset-link #Xe048ee8 r_elbow_flex_link_lk  3646.142 1758.79 713.349 / -2.892 -0.166 -1.296> #<bodyset-link #Xe096000 r_forearm_roll_link_lk  3646.142 1758.79 713.349 / -2.892 -0.166 2.074> #<bodyset-link #Xdf13ce8 r_wrist_flex_link_lk  3339.39 1680.5 766.404 / 1.521 0.528 1.566> #<bodyset-link #Xdf5fa20 r_wrist_roll_link_lk  3339.39 1680.5 766.404 / 1.521 0.528 -0.016>))
;; command : (let ((r (instance pr2-sensor-robot :init))) (progn (send r :newcoords (make-coords :4x4 #2f((0.026793 -0.999639 0.002106 3326.36) (0.999633 0.026801 0.003945 1349.16) (-0.004 0.002 0.99999 -0.854) (0.0 0.0 0.0 1.0)))) (mapc #'(lambda (j a) (send* j :joint-angle a nil)) (list (send r :torso_lift_joint) (send r :l_shoulder_pan_joint) (send r :l_shoulder_lift_joint) (send r :l_upper_arm_roll_joint) (send r :l_elbow_flex_joint) (send r :l_forearm_roll_joint) (send r :l_wrist_flex_joint) (send r :l_wrist_roll_joint) (send r :r_shoulder_pan_joint) (send r :r_shoulder_lift_joint) (send r :r_upper_arm_roll_joint) (send r :r_elbow_flex_joint) (send r :r_forearm_roll_joint) (send r :r_wrist_flex_joint) (send r :r_wrist_roll_joint) (send r :head_pan_joint) (send r :head_tilt_joint)) '(50.0 110.0 74.0 70.0 -120.0 20.0 -30.0 180.0 -15.5326 32.7327 -79.4761 -121.542 -179.057 -106.754 250.856 -1.12702 58.7871)) (objects (list r))) (send* r :inverse-kinematics (list (make-coords :pos #f(3352.0 1805.37 684.995) :rot #2f((3.174644e-06 -1.0 3.960159e-09) (0.866025 2.751300e-06 0.500001) (-0.500001 -1.583895e-06 0.866025))) :dump-command nil :debug-view t :move-target (let* ((p (send r r_gripper_tool_frame_lk)) (c (make-cascoords :coords (send (send p :copy-worldcoords) :transform (make-cascoords :4x4 #2f((1.0 0.0 0.0 0.0) (0.0 1.0 0.0 0.0) (0.0 0.0 1.0 0.0) (0.0 0.0 0.0 1.0)))) :parent p))) c) :link-list (list (send r r_shoulder_pan_link_lk) (send r r_shoulder_lift_link_lk) (send r r_upper_arm_roll_link_lk) (send r r_elbow_flex_link_lk) (send r r_forearm_roll_link_lk) (send r r_wrist_flex_link_lk) (send r r_wrist_roll_link_lk)) :rthre 0.087266 :thre 10 :stop 300 :additional-weight-list ((#<bodyset-link #Xe266e18 torso_lift_link_lk  3326.789 1302.498 840.013 / 1.544 0.004 0.002> 0.005)) :link-list (list (send r r_shoulder_pan_link_lk) (send r r_shoulder_lift_link_lk) (send r r_upper_arm_roll_link_lk) (send r r_elbow_flex_link_lk) (send r r_forearm_roll_link_lk) (send r r_wrist_flex_link_lk) (send r r_wrist_roll_link_lk)) :move-target (let* ((p (send r r_gripper_tool_frame_lk)) (c (make-cascoords :coords (send (send p :copy-worldcoords) :transform (make-cascoords :4x4 #2f((1.0 0.0 0.0 0.0) (0.0 1.0 0.0 0.0) (0.0 0.0 1.0 0.0) (0.0 0.0 0.0 1.0)))) :parent p))) c) :move-target (let* ((p (send r r_gripper_tool_frame_lk)) (c (make-cascoords :coords (send (send p :copy-worldcoords) :transform (make-cascoords :4x4 #2f((1.0 0.0 0.0 0.0) (0.0 1.0 0.0 0.0) (0.0 0.0 1.0 0.0) (0.0 0.0 0.0 1.0)))) :parent p))) c) :collision-avoidance-link-pair nil :link-list (list (send r r_shoulder_pan_link_lk) (send r r_shoulder_lift_link_lk) (send r r_upper_arm_roll_link_lk) (send r r_elbow_flex_link_lk) (send r r_forearm_roll_link_lk) (send r r_wrist_flex_link_lk) (send r r_wrist_roll_link_lk)))))
;; dump debug command to /tmp/irtmodel-ik-11949/pr2-sensor-robot-2014-07-13-19-43-40-failure.l
;; (progn (load "/tmp/irtmodel-ik-11949/pr2-sensor-robot-2014-07-13-19-43-40-failure.l")(ik-setup)(ik-check))

Remove additional

;; inverse-kinematics failed.
;; dif-pos : #f(-30.7084 -6.19854 -7.2926)/(32.1653/10)
;; dif-rot : #f(-0.009167 -0.004614 0.043453)/(0.044649/0.087266)
;;  coords : #<coordinates #X7ee3428  3326.36 1349.16 -0.854 / 1.544 0.004 0.002>
;;  angles : (50.0 110.0 74.0 70.0 -120.0 20.0 -30.0 180.0 -15.5326 32.7327 -79.4761 -121.542 -179.057 -106.754 250.856 -1.12702 58.7871)
;;    args : ((#<coordinates #X802c1b8  3352.0 1805.37 684.995 / 1.571 0.524 -1.829e-06>) :move-target #<cascaded-coords #X93fb0a0  3347.209 1835.8 675.741 / 1.521 0.528 -0.016> :link-list (#<bodyset-link #X7029268 r_shoulder_pan_link_lk  3514.723 1297.456 839.637 / 1.293 0.004 0.001> #<bodyset-link #X702cb98 r_shoulder_lift_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 0.001> #<bodyset-link #X702d1f8 r_upper_arm_roll_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 -1.57> #<bodyset-link #X7036150 r_elbow_flex_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 -1.296> #<bodyset-link #X7036678 r_forearm_roll_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 2.074> #<bodyset-link #X6f17890 r_wrist_flex_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 1.566> #<bodyset-link #X6f01ac0 r_wrist_roll_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 -0.016>) :rthre 0.087266 :thre 10 :stop 300 :additional-weight-list ((#<bodyset-link #X7028a10 torso_lift_link_lk  3326.791 1302.495 840.013 / 1.544 0.004 0.002> 0.005)) :link-list (#<bodyset-link #X7029268 r_shoulder_pan_link_lk  3514.723 1297.456 839.637 / 1.293 0.004 0.001> #<bodyset-link #X702cb98 r_shoulder_lift_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 0.001> #<bodyset-link #X702d1f8 r_upper_arm_roll_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 -1.57> #<bodyset-link #X7036150 r_elbow_flex_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 -1.296> #<bodyset-link #X7036678 r_forearm_roll_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 2.074> #<bodyset-link #X6f17890 r_wrist_flex_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 1.566> #<bodyset-link #X6f01ac0 r_wrist_roll_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 -0.016>) :move-target #<cascaded-coords #X93fb0a0  3347.209 1835.8 675.741 / 1.521 0.528 -0.016> :dump-command nil :debug-view t :move-target #<cascaded-coords #X93fb0a0  3347.209 1835.8 675.741 / 1.521 0.528 -0.016> :link-list (#<bodyset-link #X7029268 r_shoulder_pan_link_lk  3514.723 1297.456 839.637 / 1.293 0.004 0.001> #<bodyset-link #X702cb98 r_shoulder_lift_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 0.001> #<bodyset-link #X702d1f8 r_upper_arm_roll_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 -1.57> #<bodyset-link #X7036150 r_elbow_flex_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 -1.296> #<bodyset-link #X7036678 r_forearm_roll_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 2.074> #<bodyset-link #X6f17890 r_wrist_flex_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 1.566> #<bodyset-link #X6f01ac0 r_wrist_roll_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 -0.016>) :rthre 0.087266 :thre 10 :stop 300 :link-list (#<bodyset-link #X7029268 r_shoulder_pan_link_lk  3514.723 1297.456 839.637 / 1.293 0.004 0.001> #<bodyset-link #X702cb98 r_shoulder_lift_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 0.001> #<bodyset-link #X702d1f8 r_upper_arm_roll_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 -1.57> #<bodyset-link #X7036150 r_elbow_flex_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 -1.296> #<bodyset-link #X7036678 r_forearm_roll_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 2.074> #<bodyset-link #X6f17890 r_wrist_flex_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 1.566> #<bodyset-link #X6f01ac0 r_wrist_roll_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 -0.016>) :move-target #<cascaded-coords #X829c480  3347.209 1835.8 675.741 / 1.521 0.528 -0.016> :move-target #<cascaded-coords #X82ddbf0  3347.209 1835.8 675.741 / 1.521 0.528 -0.016> :collision-avoidance-link-pair nil :link-list (#<bodyset-link #X7029268 r_shoulder_pan_link_lk  3514.723 1297.456 839.637 / 1.293 0.004 0.001> #<bodyset-link #X702cb98 r_shoulder_lift_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 0.001> #<bodyset-link #X702d1f8 r_upper_arm_roll_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 -1.57> #<bodyset-link #X7036150 r_elbow_flex_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 -1.296> #<bodyset-link #X7036678 r_forearm_roll_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 2.074> #<bodyset-link #X6f17890 r_wrist_flex_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 1.566> #<bodyset-link #X6f01ac0 r_wrist_roll_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 -0.016>))

Repair additional

;; inverse-kinematics failed.
;; dif-pos : #f(-30.7084 -6.19854 -7.2926)/(32.1653/10)
;; dif-rot : #f(-0.009167 -0.004614 0.043453)/(0.044649/0.087266)
;;  coords : #<coordinates #X75ff368  3326.36 1349.16 -0.854 / 1.544 0.004 0.002>
;;  angles : (50.0 110.0 74.0 70.0 -120.0 20.0 -30.0 180.0 -15.5326 32.7327 -79.4761 -121.542 -179.057 -106.754 250.856 -1.12702 58.7871)
;;    args : ((#<coordinates #X777ccf8  3352.0 1805.37 684.995 / 1.571 0.524 -1.829e-06>) :move-target #<cascaded-coords #X89da730  3347.209 1835.8 675.741 / 1.521 0.528 -0.016> :link-list (#<bodyset-link #X68a9970 r_shoulder_pan_link_lk  3514.723 1297.456 839.637 / 1.293 0.004 0.001> #<bodyset-link #X686f240 r_shoulder_lift_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 0.001> #<bodyset-link #X6870620 r_upper_arm_roll_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 -1.57> #<bodyset-link #X68733c8 r_elbow_flex_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 -1.296> #<bodyset-link #X6873500 r_forearm_roll_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 2.074> #<bodyset-link #X6875f78 r_wrist_flex_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 1.566> #<bodyset-link #X68762a8 r_wrist_roll_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 -0.016>) :rthre 0.087266 :thre 10 :stop 300 :additional-weight-list ((#<bodyset-link #X68a5d10 torso_lift_link_lk  3326.791 1302.495 840.013 / 1.544 0.004 0.002> 0.005)) :link-list (#<bodyset-link #X68a9970 r_shoulder_pan_link_lk  3514.723 1297.456 839.637 / 1.293 0.004 0.001> #<bodyset-link #X686f240 r_shoulder_lift_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 0.001> #<bodyset-link #X6870620 r_upper_arm_roll_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 -1.57> #<bodyset-link #X68733c8 r_elbow_flex_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 -1.296> #<bodyset-link #X6873500 r_forearm_roll_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 2.074> #<bodyset-link #X6875f78 r_wrist_flex_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 1.566> #<bodyset-link #X68762a8 r_wrist_roll_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 -0.016>) :move-target #<cascaded-coords #X89da730  3347.209 1835.8 675.741 / 1.521 0.528 -0.016> :dump-command nil :debug-view t :move-target #<cascaded-coords #X89da730  3347.209 1835.8 675.741 / 1.521 0.528 -0.016> :link-list (#<bodyset-link #X68a9970 r_shoulder_pan_link_lk  3514.723 1297.456 839.637 / 1.293 0.004 0.001> #<bodyset-link #X686f240 r_shoulder_lift_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 0.001> #<bodyset-link #X6870620 r_upper_arm_roll_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 -1.57> #<bodyset-link #X68733c8 r_elbow_flex_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 -1.296> #<bodyset-link #X6873500 r_forearm_roll_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 2.074> #<bodyset-link #X6875f78 r_wrist_flex_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 1.566> #<bodyset-link #X68762a8 r_wrist_roll_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 -0.016>) :rthre 0.087266 :thre 10 :stop 300 :additional-weight-list #<bodyset-link #X68a5d10 torso_lift_link_lk  3326.791 1302.495 840.013 / 1.544 0.004 0.002> :link-list (#<bodyset-link #X68a9970 r_shoulder_pan_link_lk  3514.723 1297.456 839.637 / 1.293 0.004 0.001> #<bodyset-link #X686f240 r_shoulder_lift_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 0.001> #<bodyset-link #X6870620 r_upper_arm_roll_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 -1.57> #<bodyset-link #X68733c8 r_elbow_flex_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 -1.296> #<bodyset-link #X6873500 r_forearm_roll_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 2.074> #<bodyset-link #X6875f78 r_wrist_flex_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 1.566> #<bodyset-link #X68762a8 r_wrist_roll_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 -0.016>) :move-target #<cascaded-coords #X79ce7e8  3347.209 1835.8 675.741 / 1.521 0.528 -0.016> :move-target #<cascaded-coords #X7a01240  3347.209 1835.8 675.741 / 1.521 0.528 -0.016> :collision-avoidance-link-pair nil :link-list (#<bodyset-link #X68a9970 r_shoulder_pan_link_lk  3514.723 1297.456 839.637 / 1.293 0.004 0.001> #<bodyset-link #X686f240 r_shoulder_lift_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 0.001> #<bodyset-link #X6870620 r_upper_arm_roll_link_lk  3542.144 1393.622 839.2 / 1.293 0.32 -1.57> #<bodyset-link #X68733c8 r_elbow_flex_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 -1.296> #<bodyset-link #X6873500 r_forearm_roll_link_lk  3646.145 1758.787 713.35 / -2.892 -0.166 2.074> #<bodyset-link #X6875f78 r_wrist_flex_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 1.566> #<bodyset-link #X68762a8 r_wrist_roll_link_lk  3339.393 1680.498 766.405 / 1.521 0.528 -0.016>))

from jsk_roseus.

snozawa commented on June 12, 2024

I fixed segmentation fault from :additional-weight-check[1].
After [1], all links in print-args will be replaced by loadable format like (send r :link link-name).

[1] euslisp/jskeus#104

@aginika
Could you update jskeus and create ik fail log again.

The diff results were as below.

dif-pos and dif-rot from ik fail logs seem not to be exactly same value as original ik dif-pos and dif-rot
because floating numbers are dumped as string into ik fail logs.
I'll close this PR because segmentation fault was fixed.
If you have any problem, please reopen this issue or create another issue.

from jsk_roseus.

aginika commented on June 12, 2024

@snozawa
Thanks a lot!!! The failur file was perfectly created and there seems not to be any problems.

I run the code with roseus and the ik-check functions seems to work!!

;; ik success log at Fri Jul 18 14:44:15 2014 on (9.00 inagaki Fri Jul 18 14:35:07 JST 2014 e6031bb f332154)
;;
;; link-list (#<bodyset-link #Xc36b4f8 r_shoulder_pan_link  3514.721 1297.459 839.637 / 1.273 0.004 0.001> #<bodyset-link #Xc3d5bd8 r_shoulder_lift_link  3544.072 1393.054 839.198 / 1.273 0.576 0.001> #<bodyset-link #Xc435ec0 r_upper_arm_roll_link  3544.072 1393.054 839.198 / 1.273 0.576 -1.386> #<bodyset-link #Xc2e4670 r_elbow_flex_link  3642.375 1713.859 621.434 / -3.04 -0.429 -1.136> #<bodyset-link #Xc331788 r_forearm_roll_link  3642.375 1713.859 621.434 / -3.04 -0.429 2.022> #<bodyset-link #Xc1b8a28 r_wrist_flex_link  3351.999 1684.125 754.995 / 1.571 0.524 1.905> #<bodyset-link #Xc1fb1a8 r_wrist_roll_link  3351.999 1684.125 754.995 / 1.571 0.524 -1.829e-06>)
;; move-target #<cascaded-coords #Xc5e7820 :rarm-end-coords  3351.999 1840.01 664.995 / 1.571 0.524 -1.829e-06>
;; rotatoin-axis t, translation-axis t
;; thre 10, rthre 0.087266, stop 300
(setq c0 '(#s(coordinates plist nil rot #2f((3.174644e-06 -1.0 3.960159e-09) (0.866025 2.751300e-06 0.500001) (-0.500001 -1.583895e-06 0.866025)) pos #f(3352.0 1805.37 684.995))))
(setq av0 #f(50.0 110.0 74.0 70.0 -120.0 20.0 -30.0 180.0 -15.5326 32.7327 -79.4761 -121.542 -179.057 -106.754 250.856 -1.12702 58.7871))
(defun pr2-sensor-robot-2014-07-18-14-44-15-setup () (let ((r (instance pr2-sensor-robot :init))) (setq *robot* r) (progn (send r :newcoords (make-coords :4x4 #2f((0.026793 -0.999639 0.002106 3326.36) (0.999633 0.026801 0.003945 1349.16) (-0.004 0.002 0.99999 -0.854) (0.0 0.0 0.0 1.0)))) (mapc #'(lambda (j a) (send* j :joint-angle a nil)) (list (send r :torso_lift_joint) (send r :l_shoulder_pan_joint) (send r :l_shoulder_lift_joint) (send r :l_upper_arm_roll_joint) (send r :l_elbow_flex_joint) (send r :l_forearm_roll_joint) (send r :l_wrist_flex_joint) (send r :l_wrist_roll_joint) (send r :r_shoulder_pan_joint) (send r :r_shoulder_lift_joint) (send r :r_upper_arm_roll_joint) (send r :r_elbow_flex_joint) (send r :r_forearm_roll_joint) (send r :r_wrist_flex_joint) (send r :r_wrist_roll_joint) (send r :head_pan_joint) (send r :head_tilt_joint)) '(50.0 110.0 74.0 70.0 -120.0 20.0 -30.0 180.0 -15.5326 32.7327 -79.4761 -121.542 -179.057 -106.754 250.856 -1.12702 58.7871)) (objects (list r))) (objects (list *robot*))))
(defun pr2-sensor-robot-2014-07-18-14-44-15-check () (let ((r *robot*)) (send* r :inverse-kinematics (list (list (make-coords :pos #f(3352.0 1805.37 684.995) :rot #2f((3.174644e-06 -1.0 3.960159e-09) (0.866025 2.751300e-06 0.500001) (-0.500001 -1.583895e-06 0.866025)))) :dump-command nil :debug-view t :move-target (let* ((p (send r :link "r_wrist_roll_link")) (mt (make-cascoords :coords (send (send p :copy-worldcoords) :transform (make-coords :4x4 #2f((1.0 0.0 0.0 180.0) (0.0 1.0 0.0 4.547474e-13) (0.0 0.0 1.0 2.273737e-13) (0.0 0.0 0.0 1.0))))))) (send p :assoc mt) mt) :link-list (list (send r :link "r_shoulder_pan_link") (send r :link "r_shoulder_lift_link") (send r :link "r_upper_arm_roll_link") (send r :link "r_elbow_flex_link") (send r :link "r_forearm_roll_link") (send r :link "r_wrist_flex_link") (send r :link "r_wrist_roll_link")) :rthre 0.087266 :thre 10 :stop 300 :additional-weight-list (list (list (send r :link "torso_lift_link") 0.005)) :link-list (list (send r :link "r_shoulder_pan_link") (send r :link "r_shoulder_lift_link") (send r :link "r_upper_arm_roll_link") (send r :link "r_elbow_flex_link") (send r :link "r_forearm_roll_link") (send r :link "r_wrist_flex_link") (send r :link "r_wrist_roll_link")) :move-target (let* ((p (send r :link "r_wrist_roll_link")) (mt (make-cascoords :coords (send (send p :copy-worldcoords) :transform (make-coords :4x4 #2f((1.0 0.0 0.0 180.0) (0.0 1.0 0.0 4.547474e-13) (0.0 0.0 1.0 2.273737e-13) (0.0 0.0 0.0 1.0))))))) (send p :assoc mt) mt) :move-target (let* ((p (send r :link "r_wrist_roll_link")) (mt (make-cascoords :coords (send (send p :copy-worldcoords) :transform (make-coords :4x4 #2f((1.0 0.0 0.0 180.0) (0.0 1.0 0.0 4.547474e-13) (0.0 0.0 1.0 2.273737e-13) (0.0 0.0 0.0 1.0))))))) (send p :assoc mt) mt) :collision-avoidance-link-pair nil :link-list (list (send r :link "r_shoulder_pan_link") (send r :link "r_shoulder_lift_link") (send r :link "r_upper_arm_roll_link") (send r :link "r_elbow_flex_link") (send r :link "r_forearm_roll_link") (send r :link "r_wrist_flex_link") (send r :link "r_wrist_roll_link"))))))
(defun ik-setup () (pr2-sensor-robot-2014-07-18-14-44-15-setup))
(defun ik-check () (pr2-sensor-robot-2014-07-18-14-44-15-check))
(setq ik-failed '((:dif-pos . (#f(-30.7121 -6.19955 -7.29337))) (:dif-rot . (#f(-0.009168 -0.004614 0.043459))

from jsk_roseus.

/tmp/irtmodel-ik failuer file will become segmentation fault when I execute with roseus about jsk_roseus HOT 9 CLOSED

Comments (9)

Related Issues (20)

Recommend Projects

React

Vue.js

Typescript

TensorFlow

Django

Laravel

D3

Recommend Topics

javascript

web

server

Machine learning

Visualization

Game

Recommend Org

Facebook

Microsoft

Google

Alibaba

D3

Tencent