ni!h S SK rS SKr " S S\5 r " S S\5 r " S S\5 r " S S \5 r " S
S \5 r " S S
\5 r " S S\5 r
g) Nc \ rS rSrS rSrg) UrdfInertial c H SU l / SQU l / SQU l / SQU l g )N r r )massinertia_xxyyzz
origin_rpy
origin_xyzselfs S/home/james-whalen/.local/lib/python3.13/site-packages/pybullet_utils/urdfEditor.py__init__UrdfInertial.__init__ s DI#D DO DO )r r r r N__name__
__module__ __qualname____firstlineno__r __static_attributes__ r r r r s r r c \ rS rSrS rSrg) UrdfContact c . SU l SU l SU l g )Nr r lateral_frictionrolling_frictionspinning_frictionr s r r UrdfContact.__init__ s D D Dr r' Nr r" r r r$ r$ s r r$ c \ rS rSrS rSrg)UrdfLink c L SU l [ 5 U l / U l / U l g )Ndummy) link_namer
urdf_inertialurdf_visual_shapesurdf_collision_shapesr s r r UrdfLink.__init__ s# DN% D D!#D r )r1 r4 r2 r3 Nr r" r r r- r- s $r r- c \ rS rSrS rSrg)
UrdfVisual c / SQU l / SQU l [ R U l SU l / SQU l SU l SU l / SQU l / SQU l
S U l g )
Nr r r r
meshfiler r r )r r r r ) r r pGEOM_BOX geom_type geom_radius geom_extents geom_lengthgeom_meshfilenamegeom_meshscale
material_rgba
material_namer s r r UrdfVisual.__init__! sS DO DOZZDND!DD 'D#D%DDr )
rB rC rD rE rA r@ rG rF r r Nr r" r r r7 r7 s
r r7 c \ rS rSrS rSrg)
UrdfCollision. c / SQU l / SQU l [ R U l SU l SU l / SQU l SU l / SQU l g )Nr r r r
r r; r< )
r r r> r? r@ rA rC rB rD rE r s r r UrdfCollision.__init__0 sC DO DOZZDNDD!D 'D#Dr )rB rC rD rE rA r@ r r Nr r" r r rJ rJ . s $r rJ c \ rS rSrS rSrg) UrdfJoint; c [ 5 U l SU l [ R U l SU l SU l SU l SU l SU l
SU l / SQU l / SQU l
/ SQU l g )N joint_dummyr
parentName childNamer )r- link
joint_namer> JOINT_REVOLUTE
joint_typejoint_lower_limitjoint_upper_limitjoint_max_forcejoint_max_velocity parent_name
child_namejoint_origin_xyzjoint_origin_rpyjoint_axis_xyzr s r r UrdfJoint.__init__= sf
DI#DO&&DO D D D D#D!DO %D %D#Dr ) r_ rb rZ r\ r] rW ra r` rY r[ rV r^ Nr r" r r rO rO ; s $r rO c \ rS rSrS rS rS rS rSS jrSS jr SS jr
S r SS
jr SS jr
S / S
Q/ S
Q/ S
Q/ S
QS S 4S jr/ S
Q/ SQS 4S jrS rSrg)
UrdfEditorL c $ U R 5 g N)
initializer s r r UrdfEditor.__init__N s OOr c / U l / U l SU l 0 U l [ R
S[ R S[ R S0U l g )Nr= JOINT_FIXEDrX JOINT_PRISMATIC) urdfLinks
urdfJoints robotNamelinkNameToIndexr> rl rX rm jointTypeToNamer s r ri UrdfEditor.initializeQ sJ DNDODN D-- !1 "36Dr c [ R " XUS9nUS UR l US UR l US UR l [ R " US 5 nXcR l [ R " XS9nSnU GHm n U S U:X d M [ 5 n
U S U
l
U S [ R :X a
U S U
l U S [ R :X a
U S S U
l U S [ R :X a# U S R! S5 U
l U S U
l U S [ R& :X a U S S U
l U S S U
l U S [ R* :X a U S S U
l U S S U
l U S U
l [ R " U S 5 U
l U S
U
l S R/ X(5 n Xl UR2 R5 U
5 US- nGMp [ R6 " XUS9n U GH\ n [9 5 n
U S U
l
U S [ R :X a
U S U
l U S [ R :X a
U S S U
l U S [ R :X a# U S R! S5 U
l U S U
l U S [ R& :X a U S S U
l U S S U
l U S [ R* :X a U S S U
l U S S U
l [ R: " US US U S U S 5 u pXl [ R " U5 U
l UR< R5 U
5 GM_ g ) NphysicsClientIdr r
r r r utf-8r r r z mat_{}_{}) r> getDynamicsInfor2 r r r getEulerFromQuaternionr getVisualShapeDatar7 r@ r? rB GEOM_SPHERErA GEOM_MESHdecoderD rE
GEOM_CYLINDERrC GEOM_CAPSULErF formatrG r3 appendgetCollisionShapeDatarJ multiplyTransformsr4 )r bodyUid linkIndexurdfLinkrv dynrpy visualShapesmatIndexv
urdfVisualnamecollisionShapes
urdfCollisionposorns r convertLinkFromMultiBody#UrdfEditor.convertLinkFromMultiBodyZ s.
G
PC"%a&H ,/FH)(+AH%
"
"3q6
*C(+%''QLH
A$)
\
t
aDAJJ $%aD*
!
aDAMM !#$Q47*
aDAKK )*1W)=*
&&'d*
#
aDAOO ##$Q47*
#$Q47*
aDANN "#$Q47*
#$Q47*
!!
! 8 81 >
#$Q4
!!)6#' ##**:6a</ 2 --gRabO
#om !!m
A$!**
%&qT
"
A$!--
$%aDG
!
A$!++
*+A$++g*>
''(t
$
A$!//
!$%aDG
!$%aDG
!
A$!..
$%aDG
!$%aDG
!$$SVCFtQqTgc!$ !"!9!9#!>m $$++M:) r c r U R 5 [ 5 nSnU R XX25 [ R " XS9S R S5 Ul [ R " XS9S R S5 U l [ U R 5 U R UR ' U R R U5 [ [ R " XS95 GHJ n[ R " XUS9n[ 5 nU R XXr5 US R S5 Ul [ U R 5 U R UR ' U R R U5 [ 5 nXxl US R S5 Ul US Ul US Ul US Ul US
Ul US Ul US Ul US
n U S: a UR Ul O.[ R " XUS9n
U
S R S5 Ul UR Ul [ R4 " XUS9n U S n U S n
US nUS n[ R6 " XUU5 u nn[ R8 " UU5 u nn[ R4 " XUS9nUS nUS n[ R6 " UUUU5 u nn[ R6 " UUU/ SQ5 u nnUUl [ R< " U5 Ul U R@ R U5 GMM g )NrS ru r rw r r
r
r r:
r r r% r r r r )!ri r- r r> getBodyInfor} r1 rp lenrn rq r range getNumJoints getJointInforO rV rW rY rZ r[ r\ r] rb r^ r_ rx r invertTransformr` ry ra ro )r r rv baseLink
baseLinkIndexj jointInfor urdfJointorgParentIndexparentJointInfodynChildchildInertiaPoschildInertiaOrnparentCom2JointPosparentCom2JointOrntmpPostmpOrn tmpPosInv tmpOrnInv dynParentparentInertiaPosparentInertiaOrnr r
orn_unuseds r initializeFromBulletBody#UrdfEditor.initializeFromBulletBody s OO zHM!!'(T wPQRSZZ[bcH]]7LQOVVW^_DN/24>>/BD++,NN(# 1>>'K
L.._Mih
##GJ$R=//8h14T^^1Dd8--.
nnH%+i n &q\ 0 0 9i &q\i$-aLi!$-aLi!"+B-i %.r]i"!*2 i }n
1
( 2 2 ..Rab / 3 : :7 C % / /i ""7Oh o o$R=$R=++ON`,>@nff . .vv >i##G_]i"1 "1 %%&68H)U^_hc3,,-=?O-? Ooc: $'i #$#;#;C#@i
oo Y'] Mr c
UR S5 SR UR S UR S UR S UR S UR S UR S US9nUR U5 SR UR US9nUR U5 SR UR
S UR
S UR
S US9nUR U5 UR S 5 g )
Nz
a
r r r
precz
z\
z
)writer r r r r )r file urdfInertial precisionstrs r
writeInertialUrdfEditor.writeInertial s JJ!"
u
|
|A | 6 6q 9,:Q:QRS:TA | 6 6q 9,:Q:QRS:T[d } fC JJsO
1
8
8 9J9JQZ
8
[CJJsO
x
" " " @ 3C JJsOJJ"#r c
t UR [ R :X a g UR S5 SR UR
S UR
S UR
S UR S UR S UR S US9nUR U5 UR S5 UR [ R :X aJ SR UR S UR S UR S US9nUR U5 UR [ R :X a+ S R UR US9nUR U5 UR [ R :X aU S
R UR UR S UR S UR S US9nUR U5 UR [ R :X a6 S R UR UR US9nUR U5 UR [ R :X a6 S R UR UR US9nUR U5 UR S
5 SR UR 5 nUR U5 SR UR" S UR" S UR" S UR" S US9nUR U5 UR S5 UR S5 g )Nz
r r r r
r
6
#
F
:
9
z
zE
r z
z
)r@ r> r r r r r r? rB r{ rA r| rD rE r~ rC rG rF )r r r r r s r writeVisualShapeUrdfEditor.writeVisualShape s q~~- JJ
q
x
x1 j 3 3A 6z7L7LQ7O1 j 3 3A 6z7L7LQ7OV_ y aC JJsOJJ#$qzz) K R RS]SjSjklSm q!*"9"9!"<9
S
Nc
jjoq}}, 8 ? ?
@V@V
@
c
jjoq{{* ] d d"":#<#
r r r r
r r r r r r r r z
)r r r r r@ r> r? rB r{ rA r| rD rE r~ rC r )r r r r r s r writeCollisionShape UrdfEditor.writeCollisionShape sL JJ"#
q
x
x a !9!9!!<]=U=UVW=X a !9!9!!<]=U=UVW=X_h y jC JJsOJJ#$ !**, K R RS`SmSmnoSp!!!$]%?%?%B
S
Tc
jjo !--/ 8 ? ?
@Y@Y
@
c
jjo !++- ] d der fE fE##A&}'C'CA'F}GcGcdeGflu
e
wc
jjo !//1 Q X X -";";)
Y
Mc
jjo !..0 P W W -";";)
X
Mc
jjoJJ$%JJ#$r c UR S5 UR UR 5 UR S5 U R XR 5 SnUR H% nUR
[ R :X d M# SnM' U( a+ U( d$ UR H nU R X5 M UR H nU R X5 M UR S5 g )Nz
FTz
) r r1 r r2 r3 r@ r> r r r4 r )r r r saveVisuals hasCapsulesr cs r writeLinkUrdfEditor.writeLink* s JJ !JJx!!"JJwt 3 34K
(
(
++
' ) K**! d& +
+
+
t' ,JJ} r c
SnUR [ R :X a UR UR : a SnOSnUR [ R
:X a SnUR [ R :X a SnSR UR U5 nUR U5 SR UR 5 nUR U5 SR UR 5 nUR U5 US:X d US:X aR UR nUR nUR nUR n S R XXyUS
9nUR U5 UR S 5 S R UR S
UR S UR S US
9nSR UR S
UR S UR S UR S
UR S UR S US
9nUR U5 SR UR S
UR S UR S US
9nUR U5 UR S5 g )Ninvalid
continuousrevolutefixed prismaticz
z
z
z_
r z.
z6
r r r
z`
z4
z
)rY r> rX r[ rZ rl rm r rW r r^ r_ r\ r] r` ra rb )
r r r r jointTypeStrr
lowerLimit
upperLimitmaxForce maxVelocitys
r
writeJointUrdfEditor.writeJoint; sg Lq / // $ $y'B'B B# ! q}}, lq 0 00 l
/
6
6y7K7K\
ZCJJsO
'
.
.y/D/D
ECJJsO
&
-
-i.B.B
CCJJsO{"lj&@ ..j ..j**h 00k p w w
i
x
Ic
jjoJJFG
G
N
NyOiOijkOl "9#=#=a#@y O RC
s
z
z |E |V |V WX |Y "9#=#=a#@ " "9#=#=a#@y { RC
JJsO
E
L
LYMeMefgMh a !9!9!!<9 M NCJJsOJJ~ r c [ US5 nUR S5 UR S5 UR U R 5 UR S5 U R H nU R X4U5 M U R
H nU R
X55 M UR S5 UR 5 g )Nwz
z
getQuaternionFromEulerr r r2 r r ry r3 r4 rO rV rW rX rY rZ r[ r^ r_ r` ra rb insert)r childEditorparentLinkIndexjointPivotXYZInParentjointPivotRPYInParentjointPivotXYZInChildjointPivotRPYInChildparentPhysicsClientIdchildPhysicsClientIdchildLinkIndexinsertJointIndexrV r jointPivotQuatInChildinvJointPivotXYZInChildinvJointPivotQuatInChildr r r r childLink
parentLinks r joinUrdfUrdfEditor.joinUrdfx s (N4??+ %%-0 -@d4>>*
nnD! & ''
oo U# ( 4 45I J898I8I 955
##DNN>$B$P$P$[$[$%$<$<(,~(F(T(T(_(_%a$;$<4I KHC ?BDNN>"00;>?>V>VWZ>[DNN>"00;
^^N
+
>
>%%allA4L4LQ\\4Z&=Yhc3al--c2al ? ^^N
+
A
A%%allA4L4LQ\\4Z&=Yhc3al--c2al B ~.I 0J KEEJ%E''E E E",,E **E 2 2$E OO+3 Lr r c [ U R 5 S:X a gU R S nUR R nSn/ n/ n/ n / n
/ n / n / n
/ nUR GH nUR
nUR
U5 U R
SUR S - SUR S - SUR S - /5 UR
UR 5 U
R
UR 5 U R
UR 5 U R
UR 5 U
R
UR 5 [ R " UR 5 nUR
U5 GM [ U5 ( a [ R " UUU U
U U U
UUS9 nUR" nU Vs/ s H oR
PM nnU VVs/ s H" oR Vs/ s H nUS- PM
snPM$ nnnU Vs/ s H oR PM nnU Vs/ s H oR PM nnU Vs/ s H oR PM nnU Vs/ s H oR PM nnU Vs/ s H oR$ PM nnU Vs/ s H oR PM nnU Vs/ s H# n[ R " UR 5 PM% n nSn [ U5 ( a [ R& " UUUUUUUUU US9
n / n / n / n / n!/ n"/ n#/ n$/ n%/ n&/ n'U R( GHZ n(U(R* n)U)R R n*Sn+Sn,/ SQn-/ SQn./ SQn// SQn0U R, U(R. n1U(R0 n2U(R2 n3/ n4/ n5/ n6/ n
/ n / n7/ n8/ n9U)R GH nUR
nU4R
U5 U6R
SUR S - SUR S - SUR S - /5 U5R
UR 5 U
R
UR 5 U R
UR 5 U7R
UR 5 U8R
UR 5 U9R
[ R " UR 5 5 GM [ U45 ( a [ R " U4U5U6U
U U7U8U9US9 n+U)R" nSn,U Vs/ s H oR
PM nnU VVs/ s H" oR Vs/ s H nUS- PM
snPM$ nnnU Vs/ s H oR PM nnU Vs/ s H oR PM nnU Vs/ s H oR PM nnU Vs/ s H oR PM nnU Vs/ s H oR$ PM nnU Vs/ s H oR PM nnU Vs/ s H# n[ R " UR 5 PM% n n[ U5 ( a) [5 S U5 [ R& " UUUUUUUUU US9
n,U R
U*5 U R
U+5 U R
U,5 U!R
U(R6 5 U"R
[ R " U(R8 5 5 U#R
U)R R 5 U$R
[ R " U)R R 5 5 U%R
U15 U&R
U(R0 5 U'R
U(R2 5 GM] [ R: " U40 S
U_S U _S U_S
U_SUR R _S[ R " UR R 5 _SU _SU _SU _SU!_SU"_SU#_SU$_SU%_SU&_SU'_SU_6n:U:$ s snf s snf s snnf s snf s snf s snf s snf s snf s snf s snf s snf s snf s snnf s snf s snf s snf s snf s snf s snf s snf )Nr rS g ?r r
)
shapeTypesradii halfExtentslengths fileNames
meshScalescollisionFramePositionscollisionFrameOrientationsrv )
r r r r r r
rgbaColorsvisualFramePositionsvisualFrameOrientationsrv r z
fileNames=baseCollisionShapeIndexbaseVisualShapeIndex basePositionbaseOrientationbaseInertialFramePosition baseInertialFrameOrientation
linkMasseslinkCollisionShapeIndiceslinkVisualShapeIndices
linkPositionslinkOrientationslinkInertialFramePositions linkInertialFrameOrientationslinkParentIndiceslinkJointTypes
linkJointAxisrv ) r rn r2 r r4 r@ r rB rA rC rD rE r r> r r createCollisionShapeArrayr3 rF createVisualShapeArrayro rV rq r^ rY rb printr` ra createMultiBody);r r r rv basebaseMassr
baseShapeTypeArraybaseRadiusArraybaseHalfExtentsArray lengthsArray
fileNameArraymeshScaleArraybasePositionsArraybaseOrientationsArrayr shapeTyper urdfVisualsr extr r r r r r
r r r r r r r r r r r r r r rV linkMasslinkCollisionShapeIndexlinkVisualShapeIndex linkPositionlinkOrientationlinkInertialFramePosition linkInertialFrameOrientationlinkParentIndex
linkJointType linkJointAxlinkShapeTypeArraylinkRadiusArraylinkHalfExtentsArraylinkMeshScaleArraylinkPositionsArraylinkOrientationsArrayobUids; r r UrdfEditor.createMultiBody s
DNNq
>>! D !!&&H O LMN
'
'++i *!! " "C!..*;$;S1>>RSCT=T
UW Q]]+!--(1../A , ,- -
$ $Q\\ 2c""3' ( ! ; ;' * !#"4%:) !+ ))K'23{!++{J3BMN+Q 8 #C#I 8+KN$/ 0Kq]]KE 0&12k}}kG2.9:k$$kI:,78Kq""KJ8+67;a//;J72=>+QLL+>OZ [{!q 7 7 E{ [ J 5 5 ! 3"9)
+ J " M!# $&!NM
ZZd##((h " l!o"+ %." ,,U->->?o&&m((k o lm ))!KK !!), ##
1>>!$
$cANN1,=&=sQ^^TUEV?V W Y q}}-AMM* Q 0 01!!!"2"23!!!,,/ $$Q%=%=all%KL *
!
!"#"="=)!, #)$6'< + #- ++k )45AKKj5DOPKq>>:>CcCi>:KkP&12k}}ke2(34 1 g40;< 1&& i<.9:k$$kj:-89[OO[j94? @KqllK @Q\ ]Q\A!9!9!,,!GQ\ ]
j//
lI& 7 7!# !!!5$; +
- ! &&'>? ##$895112 a 6 6u7M7M NO ''(:(:(E(EF#**1+C+CDDVDVDaDa+bc /E , ,-5//0c !d
h
( 6
(?S
( !
( '
(
"&!3!3!>!>
( %&$<$ [j 6:P24<:9 @ ]s <`
`+` :``#` >`$`)4`.`3**`8
`=&a9aaa
1a a'a a! a&8*a+`ac g rh r" r s r __del__UrdfEditor.__del__ s r )rr rq rp ro rn N)r )T)r r r r r ri r r r r r r r r r r rA r! r" r r re re L sm 69;v;(z
$ )"V %< "( T* !%.%.$-$-%&$%EP $-&2&'GR r re ) pybulletr> timeobjectr r$ r- r7 rJ rO re r" r r rF sa 6 & $v $
$F
$$ $"} } r