FK (Forward Kinematic) With Excel, Arduino & Processing

by Miftahul_Arif in Circuits > Arduino

803 Views, 6 Favorites, 0 Comments

FK (Forward Kinematic) With Excel, Arduino & Processing

Forward Kinematic.jpg

Forward Kinematic is used to find End Effector values (x, y, z) in 3D space.

Basic Theory

20191202_142929.jpg

In principle, forward kinematic uses the theory of trigonometry that
is combined (joint). With the length (r) and angle (0) parameters, the End Effector position can be known, namely (x, y) for 2D space and (x, y, z) for 3D.

Model

20191129_145520.jpg

The model is assumed with teta1 (0 degree), teta1 (0 degree), teta2
(0 degree), teta3 (0 degree), teta4 (0 degree). And length a1-a4 = 100mm (can be changed as desired). Angles and lengths can be simulated in Excel (download file).

End Effector

20191129_145552.jpg

From the matrix above the formula is simulated using Excel.

Excel Simulation

Forward Kinematic Excel1.jpg
Forward Kinematic Excel.jpg
In Excel1 is the basic theory of reference. For angles and lengths can

be modified as needed. Which will later be known End Effector (xyz). For Excel is a system that I made.

Arduino Diagram and Sistem

20191202_140931.jpg
20191202_140922.jpg
20191202_135648.jpg

Supplies :
1. Arduino Uno 1 pcs

2. Potentiometer 100k Ohm 5 pcs

3. Cable (needed)

4. PC (Arduino IDE, Excel, Processing)

5. USB Cable

6. Cardbard (needed) I put Arduino Uno in a used PLC box to avoid static electricity. For wiring diagrams see figure. For the Forward Arm Kinematic raft hardware system in accordance with the system that has been made.

Arduino Program Upload

Arduino Program.jpg

Arduino program files are in the download file.

Processing Simulasion

Processing.jpg

Program on File Downloaded.

Final

Forward Kinematic.jpg
Forwad Kinematic

Reference :
1. https://www.thingiverse.com/thing:2882172

2. Theory (on file download)

3. https://youtu.be/ootJaik2iow