2dof-arm-control

The goal of the project was control the arm and draw or write a given shape or character using a pen at the end-effector. Inverse kinematics, PWM control, and one cosine methods are used in the task.

Setup:

  • Arduino Mega
  • Servo Motor MG996R x 2
  • Arduino Cable
  • Jump Cables
  • 3D printed arm
  • Pen

The first test (and i know this is not perfect as expected):

ro.mp4

Conclusion: First of all, I did not properly secured the pen at the end effector. It was not possible to control at high precision because the board and the motors could not computationally handle small steps, which is necessary for high precision and the arm beam is deflected when assembled. For these reasons, it was not possible to draw a straight and smooth line.

Tip: Test on the plain surface;)