Open Jig Ware

1

Open Jig Ware : : Mail : [email protected]

3D , , . , Forward/Inverse , .Forward Kinematics .D-H Notation 3D , C# Using, , , Drawing 4 3D (, , , ) . DLL 255 . Message History, Timer, Joystick, Graph, , File /, .3D

OpenJigWare ?

?

. ? . ?Kinematics .

Making the suit2008. Iron man

Microsoft Visual Studio 2010C# ( with Tao frame work : OpenGL )

https://youtu.be/l_QerQFRaZkhttps://youtu.be/GY4MUXbbW20

. Jig . 3D 2 / / 5 D-H Notation 3D & Tool DLL . Tool .Ex) OpenCV DLL DLL Using OpenJigWare ROS ?

Source & DLLOpenJigWare https://github.com/ojw5014/OpenJigWare, .. Github Github ~~~Manual Document .www.youtube.com ojw5014 OpenJigWare [Example] .Ex ) https://www.youtube.com/watch?v=tqgSO_PA_cU

.

?

Message History MessageBox History Message ( )Convert . Parameter Loading . .Dst robot( ) , ( Rpm Time )3D 2D 3D .Forward / Inverse Kinematics

2D 3D

()

. 10 3D . OpenGL .Forward / Inverse Kinematics .

. Cad .ASE, OBJ, STL(text/binary) ., , Mirror , , Limit, (/ ), , ID, Flip (, , Mirror ), , / ., , , , .

[ ]

Modeling toolMotion tool

,

https://www.youtube.com/watch?v=ol29At-4OWc 200https://www.youtube.com/watch?v=_c2tNN-tayA

https://youtu.be/BEr_5CZqk-whttps://youtu.be/srUZRiMfd8k

Cad . Step 1 Cad (obj, ase, stl . ase .)

Cad . Step 2 DispObject .# 17 Ase . .

Cad . Step 3 Add .

1. Offset 100 45 2. Y 50 , Y 45 1. Offset 2. Trans / Rotation ( OpenGL 3D )

Cad . Step 4 Add .( )

. Property grid. . Virtual Object( .)

(60%) . .

()Manipulator

( )

. . Ctrl^C, Ctrl^V . Switch

Switch / / , , . : Switch

(HexaPod )

. . Ctrl^C, Ctrl^V . Switch

Switch . :

: Switch

Genibo Hovis series DR-Sim Sync

. Github https://github.com/ojw5014/OpenJigWare ?

OpenSource

TeacherStudentModeling Tool

Using OpenJigware.dllDrawing(3D)Motor (Limit, ) Engineer

Visual Studio C# ( 4)

Modeling Tool (, , , ) Drawing(3D)Motor (Limit, )

. , Maya, 3D Max 3D ( obj, ase, stl[Binary or Text] .)Autodesk 123Design .() Drawing .

? [1/2]

!!!.3D , Thingiverse, Yeggi

? [2/2]

http://www.thingiverse.comhttp://www.yeggi.com/

( ) & 1 2 2 4 3 4 ID

(Non-Case Sensitive)=> X, Y, Z( )T0 ~ T255 : V0 ~ V252 : External ( : . 0 =(), +, -, *, /, %()V0 ~ V252 : External ( ) : sin(), cos(), tan(), asin(), acos(), atan(), pow(,), sqrt(,), abs(), atan2(,), acos2(), asin2()_, ; : ( ) .++, , +*, */, /- ( )+, -, *, /, % . Radian , .

String separate . ._V() .Sort (X,/,%)

, V , T , , Basic , 1

Basic Assembler 2

Assembler Code 3

Code GenerationCode Binary Code ( ) . 4

Over ?

?

////////////////////////////////////////////////////////////////////// // (-1), (1) - //v1=pow(-1,(v0 + 1)) // 0(-1), 1(1), 2(-1). 3(1). 4(-1). 5(1). 6(-1). 7(1). 8(-1), 9(1), 10(-1)

// 0, -1, 1 - //a=5//v1=(v0-a)/abs(v0-a) // 0(-1), 1(-1), 2(-1). 3(-1). 4(-1). 5(0). 6(1). 7(1). 8(1), 9(1), 10(1)

// 0, 1//a=5//v1=abs((v0-a)/abs(v0-a)) // 0(1), 1(1), 2(1). 3(1). 4(1). 5(0). 6(1). 7(1). 8(1), 9(1), 10(1)

// 1, 0//a=5//v1=abs(abs((v0-a)/abs(v0-a))-1) // 0(1), 1(1), 2(1). 3(1). 4(1). 5(0). 6(1). 7(1). 8(1), 9(1), 10(1)////////////////////////////////////////////////////////////////////

//v0 = 0 = ( + v1(tilt) + v2(swing))//v0 = 1 = ( + v1(tilt) + v2(swing))//v0 = 2 = ( + v1(tilt) + v2(swing))//v0 = 3 ( )//v0 = 4 ( )//v1 = offset (Tilt)//v2 = offset (Swing)

Kinematics ?Kinematics

37About KinematicsForward kinematicsJoint Angle Cartesian space(x, y, z)Simple and Unique solutionInverse kinematicsCartesian space(x, y, z) Joint AngleIt is not a unique solution, difficult(but delta system) Sometimes we have singular position or some position we cannot go

The Leader of Intelligence Robot

38Forward Kinematics(1/2)

Translation

to Matrix


39Forward Kinematics(2/2)

Rotation : R


40Forward Kinematics (D-H Notation)

T(Transformation Matrix)It has rotation and translation in their 4 * 4 matrix

Parameter

DefineX(i+1) and Z(i) is orthogonalX(i+1) and Z(i) has a matching point


41D-H Notation Matrix



D-H Notation https://youtu.be/7lqSJNfkxe8


kinematicsD-H Notation 2 D-H 3D 3D D-H Notation . 0


45Forward Kinematics & Program(1/2)

D-H Notation

1 0 0 00 1 0 00 0 1 -2460 0 0 11 0 0 00 0 1 00 -1 0 00 0 0 1C(t2) -S(t2) 0 0S(t2) C(t2) 0 0 0 0 1 190 0 0 0 1 a d 0 [ 0, -246, 0, 0]1 [ 0, 0, 0, -90]2 [ 0, 190, 2, 0]3 [ 0, 200, 0, 0]4 [ 0, 0, 90, 90]5 [625, 0, 3+90, 0]6 [482, 0, 4, 0]7 [ 0, 0, 5, 0] // Orientation1 0 0 00 0 0 00 0 1 2000 0 0 10 0 1 01 0 0 00 1 0 00 0 0 1C(t3+90) -S(t3+90) 0 625*C(t3+90)S(t3+90) C(t3+90) 0 625*S(t3+90) 0 0 1 0 0 0 0 1C(t4) -S(t4) 0 482*C(t4)S(t4) C(t4) 0 482*S(t4) 0 0 1 0 0 0 0 1Add Rotation(5)


46Forward Kinematics & Program(2/2)https://youtu.be/detjVR1dG08


47Kinematics

-S(t2)*C(t3+90)*C(t4)-S(t2)*-S(t3+90)*S(t4)*C(t5) -S(t2)*C(t3+90)*C(t4)-S(t2)*-S(t3+90)*S(t4)*-S(t5) C(t2) -S(t2)*C(t3+90)*482*C(t4)-S(t2)*-S(t3+90)*482*S(t4)-S(t2)*625*C(t3+90)-S(t2)*C(t3+90)*-S(t4)-S(t2)*-S(t3+90)*C(t4)*S(t5) -S(t2)*C(t3+90)*-S(t4)-S(t2)*-S(t3+90)*C(t4)*C(t5)

S(t3+90)*C(t4)+C(t3+90)*S(t4)*C(t5)+ S(t3+90)*C(t4)+C(t3+90)*S(t4)*-S(t5)+S(t3+90)* 0 S(t3+90)*482*C(t4)+C(t3+90)*482*S(t4)+625*S(t3+90)+200+190S(t3+90)*-S(t4)+C(t3+90)*C(t4)*S(t5) -S(t4)+C(t3+90)*C(t4)*C(t5)

-1*C(t2)*C(t3+90)*C(t4)-1*C(t2)*-S(t3+90)*S(t4)*C(t5) -1*C(t2)*C(t3+90)*C(t4)-1*C(t2)*-S(t3+90)*S(t4)*-S(t5) -1*S(t2) -1*C(t2)*C(t3+90)*482*C(t4)-1*C(t2)*-S(t3+90)*482*S(t4)-1*C(t2)*625*C(t3+90)-246-1*C(t2)*C(t3+90)*-S(t4)-1*C(t2)*-S(t3+90)*C(t4)*S(t5) -1*C(t2)*C(t3+90)*-S(t4)-1*C(t2)*-S(t3+90)*C(t4)*C(t5)

0 0 0 1

[Axis X][Axis Y][Axis Z][Result]

X = -Sin(t2) * Cos(t3+90) * 482 * Cos(t4) - Sin(t2) * -Sin(t3+90) * 482 * Sin(t4) - Sin(t2) * 625 * Cos(t3+90)Y = Sin(t3+90) * 482 * Cos(t4) + Cos(t3+90) * 482 * Sin(t4) + 625 * Sin(t3+90) + 200 + 190Z = -1 * Cos(t2) * Cos(t3+90) * 482 * Cos(t4) 1 * Cos(t2) * -Sin(t3+90) * 482 * Sin(t4) 1 * Cos(t2) * 625 * Cos(t3+90) - 246

[For example ] t2 = 30 t3 = 60 t4 = 110 t5 = -60=====================================X = -S(t2)*C(t3+90)*482*C(t4)-S(t2)*-S(t3+90)*482*S(t4)-S(t2)*625*C(t3+90) = 312.4821495Y = S(t3+90)*482*C(t4)+C(t3+90)*482*S(t4)+625*S(t3+90)+200+190 = 227.822663Z = -1*C(t2)*C(t3+90)*482*C(t4)-1*C(t2)*-S(t3+90)*482*S(t4)-1*C(t2)*625*C(t3+90)-246 = 295.2349594


48Inverse Kinematics (1/2)

T3

W0

H0

H1

L0

L1

L2

T2

T4

T5

P0

P1

P2

P0

P1

P2P0(0, H0 + H1, -W0)P2(x, y, z)|P0->P2| =sqrt(x^2 + (y-H0-H1)^2 + (z-W0)^2) => ab = L1c = L0fTheta4=acos ((b^2+c^2-a^2)/(2*b*c))T4=180-fTheta4


49Inverse Kinematics (2/2)fT34=t3+t4fT5=t5

H0=190H1=200H=H0+H1W0=-246L0=625L1=482

depth=z-W0width=xt2=atan2(depth,width)

b = L1c = L0

Length2=x*x + pow(y-H,2) + pow(z-W0,2)Length=sqrt(Length2,2)

fTheta4=acos((b*b+c*c-Length2)/(2*b*c))t4=180-fTheta4/////////////

b = Lengthbb=Length2c = H1+H0aa=x*x + y*y + pow(z-W0,2)fTheta3_0=acos((bb+c*c-aa)/(2*b*c))

b = L0a = L1c = LengthfTheta3_1=acos((b*b+c*c-a*a)/(2*b*c))T3=180-(fTheta3_0 + fTheta3_1)

t5=fT5 + fT34 - t3 - t4


50Resulthttps://youtu.be/CWA8UQt0df8


Gate / Sway / COG https://youtu.be/zlp9k4NL1qo2 http://www.homerobot.co.kr/kaist_soc/motion_editor_for_walking.ziphttps://youtu.be/F8UgMhH9TXY

52Enjoy this Walking Motion

https://youtu.be/YIM-lIvMcaw


& http://www.homerobot.co.kr/kaist_soc/calibration.zip

? . .

54 . A person longing for any dream for a long time resembles that dream at last. -Andre Georges Malraux.


Dance

https://youtu.be/DIboVjYI-Pg

Dance

https://youtu.be/EzZl6u_HEfQ

Dance

https://youtu.be/xfXejDcTBM4

Dance

https://youtu.be/4Az1QcfQdhM

Dance

https://youtu.be/w5jqQ5LecDM

Dance

https://youtu.be/bjH7cu9Tuxs

https://youtu.be/rYg4peMuhJE

Open Jig Ware

Software

Transcript of Open Jig Ware