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 is used to find End Effector values (x, y, z) in 3D space.
Basic Theory
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
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
From the matrix above the formula is simulated using Excel.
Excel Simulation
be modified as needed. Which will later be known End Effector (xyz). For Excel is a system that I made.
Arduino Diagram and Sistem
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 files are in the download file.
Processing Simulasion
Program on File Downloaded.
Final
Reference :
1. https://www.thingiverse.com/thing:2882172
2. Theory (on file download)
3. https://youtu.be/ootJaik2iow