Delta-Kinematics-Library

Categories: Libraries

https://github.com/tinkersprojects/Delta-Kinematics-Library

Delta-Kinematics-Library

Categories: Libraries

https://github.com/tinkersprojects/Delta-Kinematics-Library

Delta-Kinematics-Library

https://tinkersprojects.com/ Forward and Inverse Kinematics Library for Delta robot.

Thank you to:

Functions

SETUP

DeltaKinematics(double ArmLength,double RodLength,double BassTri,double PlatformTri)

This Fuction is set up the class to calulate the forward and inverse kinematics for the delta. ArmLength, RodLength, BassTri and PlatformTri are the set values from the Delta robot. See image above to see how to take the measurement. Millimetre, meters, inches or any other lenth measurement can be used for ArmLength, RodLength, BassTri and PlatformTri. The measurement will need to be the same for x, y and z. It is recommended to use Millimetre for ArmLength, RodLength, BassTri and PlatformTri

SETUP

int forward()

int forward(double thetaA, double thetaB, double thetaC)

This functions is to calulate the forward kinematics of for the delta. The calulations can be set using the variables a, b and c or in the function with ThetaA, thetaB and thetaC. ThetaA, thetaB and thetaC valuse are in degrees. a, b and c valuse are in degrees (see Variables below). See image above.

int inverse()

int inverse(double x0, double y0, double z0)

This function is to calculate the inverse kinematics of the delta. The calculations can be set using the variables x, y and z or in the function with x0, y0 and z0. It is recommended to use Millimetre for x, y and z

Variables

double x, double y, double z

These variables (x, y and z) and be read and written. They are used to set the position of the Delta robot's platform for Kinematics. If forward kinematics are calculated, the return values are placed in x, y and z. It is recommended to use Millimetre for x, y and z

double a, double b, double c

These variables (a, b and c) and be read and written. They are used to set the angle of the Delta robot's motors for Kinematics. If inverse kinematics are calculated, the return values are placed in a, b and c. a, b and c values are in degrees. See the image above.

Code for Project

GNU General Public License v3.0

#include <DeltaKinematics.h>

DeltaKinematics DK(70,300,139,112);

void setup() 
{  
  Serial.begin(115200);
}

void loop() 
{
  DK.x =  0;
  DK.y =  0;
  DK.z = -300;
  DK.inverse();
  // OR
  DK.inverse(0,0,-300);

  Serial.println(String(DK.x)+","+String(DK.y)+","+String(DK.z));
  Serial.println(String(DK.a)+","+String(DK.b)+","+String(DK.c));
  Serial.println();
  delay(3000);



  // next position 
  
  DK.x =  0;
  DK.y =  0;
  DK.z = -270;
  DK.inverse();
  // OR
  DK.inverse(000,000,-270);

  Serial.println(String(DK.x)+","+String(DK.y)+","+String(DK.z));
  Serial.println(String(DK.a)+","+String(DK.b)+","+String(DK.c));
  Serial.println();
  delay(3000);



  // next position 
  
  DK.x =  100;
  DK.y =  100;
  DK.z = -270;
  DK.inverse();
  // OR
  DK.inverse(100,100,-270);

  Serial.println(String(DK.x)+","+String(DK.y)+","+String(DK.z));
  Serial.println(String(DK.a)+","+String(DK.b)+","+String(DK.c));
  Serial.println();
  delay(3000);
}

Delta-Kinematics-Library

https://tinkersprojects.com/ Forward and Inverse Kinematics Library for Delta robot.

Thank you to:

Functions

SETUP

DeltaKinematics(double ArmLength,double RodLength,double BassTri,double PlatformTri)

This Fuction is set up the class to calulate the forward and inverse kinematics for the delta. ArmLength, RodLength, BassTri and PlatformTri are the set values from the Delta robot. See image above to see how to take the measurement. Millimetre, meters, inches or any other lenth measurement can be used for ArmLength, RodLength, BassTri and PlatformTri. The measurement will need to be the same for x, y and z. It is recommended to use Millimetre for ArmLength, RodLength, BassTri and PlatformTri

SETUP

int forward()

int forward(double thetaA, double thetaB, double thetaC)

This functions is to calulate the forward kinematics of for the delta. The calulations can be set using the variables a, b and c or in the function with ThetaA, thetaB and thetaC. ThetaA, thetaB and thetaC valuse are in degrees. a, b and c valuse are in degrees (see Variables below). See image above.

int inverse()

int inverse(double x0, double y0, double z0)

This function is to calculate the inverse kinematics of the delta. The calculations can be set using the variables x, y and z or in the function with x0, y0 and z0. It is recommended to use Millimetre for x, y and z

Variables

double x, double y, double z

These variables (x, y and z) and be read and written. They are used to set the position of the Delta robot's platform for Kinematics. If forward kinematics are calculated, the return values are placed in x, y and z. It is recommended to use Millimetre for x, y and z

double a, double b, double c

These variables (a, b and c) and be read and written. They are used to set the angle of the Delta robot's motors for Kinematics. If inverse kinematics are calculated, the return values are placed in a, b and c. a, b and c values are in degrees. See the image above.

Latest projects

PCB Rover Robot WiFi

This is the second version of this little robot. I redesign. It to have an ESP8266 so it can be controlled over WiFi. The robot mostly surface mount components, most were are new parts. ...

SPRIED

For the past year, I have been working towards many different projects, all accessable and open for anyone to use. It has taken a lot of time and effort to get to a point of starting to...

10 Channel Temperature Logger

I challenged myself to make a fully working and functioning 10 channel temperature logger as fast as I could. It took me 5 hours to create the circuit and PCB. During this time I added...

Blackening/Blueing of steel parts

After doing a lot of different tests with electroplating, I wanted to try other ways of protecting steel from rusting. One of the easiest ways is called Blueing. it may be the easiest but it...

Popular projects

Coil Winding Machine

I'm will be making a new machine soon that will be able to do more with a better control system. Please send me a message here https://tinkersprojects.com/contact-me/ if you would like to...

Novation Launchpad Mini Repair

I got this Novation Launchpad Mini on eBay a while ago and have just got around to getting it apart to see whats wrong. The item was marked as not working so I messaged the seller to find out what...

PLEX Controller

PLEX is a development board using the Arduino UNO bootloader to be easily programmed by the Arduino IDE. The board has many selectable analog inputs and digital output (up to 32, not including...

LCD-Simple-Menu Library

This is a simple LCD Menu Library for Arduino to make menus to control robots and machines. Menu Systems on an LCD has always been a thing that has gotten in the way of developing...