3DOF Inverse Kinematics For Arm/Leg of Robot Using Arduino

Inverse Kinematics

Arduino Code:

const float cx=2; //coxa
const float fm=6.2; //femur
const float tb=8.3; // tibia
float L, L1;
float alpha, alpha1,alpha2,beta,gama;
void setup()
{
 Serial.begin(9600); 
}
void loop()
{
trigono_xyz(2, 4, 6); //contoh x,y,z
Serial.print("gama= ");
Serial.print(gama);
Serial.print(", alpha= ");
Serial.print(alpha);
Serial.print(", beta= ");
Serial.print(beta);
Serial.println();
}

void trigono_xyz(float x, float y, float z)
{
 L1=sqrt(sq(x)+sq(y));
 gama=atan(x/y)/PI*180;
 L=sqrt(sq(L1-cx)+sq(z));
 beta=acos((sq(tb)+sq(fm)-sq(L))/(2*tb*fm))/PI*180;
 alpha1=acos(z/L)/PI*180;
 alpha2=acos((sq(fm)+sq(L)-sq(tb))/(2*fm*L))/PI*180;
 alpha=alpha1+alpha2;
}

Youtube: http://youtu.be/ziz6FRfRfJM

paperwork about kinematics: Robot Manipulator Control with Inverse Kinematics PD-Pseudoinverse Jacobian and Forward Kinematics Denavit Hartenberg

Deteksi Api dengan Arduino-Flame Sensor Module Digital And Analog Output

photo

Flame Sensor Module Digital And Analog Output merupakan modul pendeteksi api yang ekonomis, menggunakan photodioda untuk mendeteksi gelombang pendek inframerah (SW-NIR) cahaya api pada kisaran spektrum 700-1100 nm. Modul ini memiliki kelemahan terhadap cahaya matahari, cara mengatasinya dapat dilakukan dengan memberi tapis/filter plastik yang diatur agar modul dapat membedakan refleksi cahaya matahari dan sumber cahaya dari api yang akan dideteksi. Continue reading