scara

Source code : App made using processing version 3 for windows. Look at this diagram to get an idea of what the S and E angles are: Forward Kinematic Equations: Diagram and equations source : https://roboted.wordpress.com/fundamentals/