@@ -2233,7 +2233,9 @@ def ik_lm_chan(
22332233 TODO
22342234 """
22352235
2236- return self .ets (start , end ).ik_lm_chan (Tep , q0 , ilimit , slimit , tol , reject_jl , we , λ )
2236+ return self .ets (start , end ).ik_lm_chan (
2237+ Tep , q0 , ilimit , slimit , tol , reject_jl , we , λ
2238+ )
22372239
22382240 def ik_lm_wampler (
22392241 self ,
@@ -2342,7 +2344,9 @@ def ik_lm_wampler(
23422344 TODO
23432345 """
23442346
2345- return self .ets (start , end ).ik_lm_wampler (Tep , q0 , ilimit , slimit , tol , reject_jl , we , λ )
2347+ return self .ets (start , end ).ik_lm_wampler (
2348+ Tep , q0 , ilimit , slimit , tol , reject_jl , we , λ
2349+ )
23462350
23472351 def ik_lm_sugihara (
23482352 self ,
@@ -2451,7 +2455,9 @@ def ik_lm_sugihara(
24512455 TODO
24522456 """
24532457
2454- return self .ets (start , end ).ik_lm_sugihara (Tep , q0 , ilimit , slimit , tol , reject_jl , we , λ )
2458+ return self .ets (start , end ).ik_lm_sugihara (
2459+ Tep , q0 , ilimit , slimit , tol , reject_jl , we , λ
2460+ )
24552461
24562462 def ik_nr (
24572463 self ,
@@ -2561,7 +2567,9 @@ def ik_nr(
25612567 TODO
25622568 """
25632569
2564- return self .ets (start , end ).ik_nr (Tep , q0 , ilimit , slimit , tol , reject_jl , we , use_pinv , pinv_damping )
2570+ return self .ets (start , end ).ik_nr (
2571+ Tep , q0 , ilimit , slimit , tol , reject_jl , we , use_pinv , pinv_damping
2572+ )
25652573
25662574 def ik_gn (
25672575 self ,
@@ -2671,8 +2679,31 @@ def ik_gn(
26712679 TODO
26722680 """
26732681
2674- return self .ets (start , end ).ik_gn (Tep , q0 , ilimit , slimit , tol , reject_jl , we , use_pinv , pinv_damping )
2682+ return self .ets (start , end ).ik_gn (
2683+ Tep , q0 , ilimit , slimit , tol , reject_jl , we , use_pinv , pinv_damping
2684+ )
26752685
2686+ def ikine_LM (
2687+ self ,
2688+ Tep : Union [ndarray , SE3 ],
2689+ end : Union [str , Link , Gripper , None ] = None ,
2690+ start : Union [str , Link , Gripper , None ] = None ,
2691+ q0 : Union [ArrayLike , None ] = None ,
2692+ ilimit : int = 30 ,
2693+ slimit : int = 100 ,
2694+ tol : float = 1e-6 ,
2695+ joint_limits : bool = True ,
2696+ mask : Union [ArrayLike , None ] = None ,
2697+ ):
2698+ return self .ets (start , end ).ikine_LM (
2699+ Tep = Tep ,
2700+ q0 = q0 ,
2701+ ilimit = ilimit ,
2702+ slimit = slimit ,
2703+ tol = tol ,
2704+ joint_limits = joint_limits ,
2705+ mask = mask ,
2706+ )
26762707
26772708
26782709# =========================================================================== #
0 commit comments