Cumartesi, Temmuz 2, 2022

Kaizen 4.0

Dünyanı İyileştir

Paralel Robot Robotik 

Paralel Robot Yazılım – 4

Remzi Şahinoğlu 0 yorum , , , , , , , , , , ,

Paralel Robot Yazılım konusunda İleri kinematik denklemi matlabta yazılmış ve test edilmiştir kod aşağıdadır. Bu kodu elektronik devrede pic içinede yazılmış ve kullanılmıştır. Pic osilatör frekansı 4Mhz olduğu durumda çözümü yaklaşık 10-20sn arasında sürmektedir. Bu yüzden yüksek hızlı pic’ ler seçilmesini öneririm.

Aşağıdaki kodda dikkat edilmesi gereken öenmli nokta “robot geometri” kısmıdır. Yapılan robotun geometrisi çizim porgramlarında hassas olarak belirlenip programa girilmelidir. Aksi halde aldığınız sonuçlar doğru olmaz. Daha sonra açı değerlerini girip end-effectorun xyz konumunu alabilirsiniz.

Paralel Robot Kinematiği
Paralel Robot Kinematiği

Ters kinematik koddada xyz değerlerini girip açı değerlerini hesaplatabilirsiniz. MATLAB ta GUI kullanarak açı değerlerini veya xyz değerlerini çeşitli kontroller ile girilmesini sağlaabilir ve hesaplanan sonuçları yine seri porttan robotun elektroniğine gönderip robot kontrol edilebilir. Ben kontrol için iki farklı yöntem yaptım. İlki ters kinematik ve ileri kinematik denklemi pic in içine gömerek butonlarla kontrolü sağladım. İkinci olarak aynı kodu kullanarak visual c# programında göresel program yazarak bir çok farklı şekilde robotun kontrolü sağladım. Visual c# programını aşağıdaki koddan sonra bulabilirsiniz.

Paralel Robot Kinematiği
Paralel Robot Kinematiği
MATLAB KODU

Forward Kinematics Equation (İleri Kinematik Denklem)

% forward kinemeatics solution from mzavatsky in website
% http://forums.trossenrobotics.com/tutorials/introduction-129/delta-robot-kinematics-3276/
% marmara üniversity engineering faculty mechanical engineering
% remzi şahinoğlu
% 18.04.2011
clear all
%clc
% robot geometry
% (look at pics above for explanation)
e = 109.12; % end effector
f = 346.41; % base
re = 323.59; % rod length
rf = 133.09; % arm length

% trigonometric constants
sqrt3 = sqrt(3.0);
pi = 3.141592653;
sin120 = sqrt3/2.0;
cos120 = -0.5;
tan60 = sqrt3;
sin30 = 0.5;
tan30 = 1/sqrt3;
% forward kinematics: (theta1, theta2, theta3) -> (x0, y0, z0)
% returned status: 0=OK, -1=non-existing position
t = (f-e)*tan30/2;
dtr = pi/180.0;
%************** açı değerlerini girin *******************
theta1 = -8.7723*pi/180.0;
theta2 = -8.7723*pi/180.0;
theta3 = -8.7723*pi/180.0;
%************** açı değerlerini girin *******************
y1 = -(t + rf*cos(theta1));
z1 = -rf*sin(theta1);
y2 = (t + rf*cos(theta2))*sin30;
x2 = y2*tan60;
z2 = -rf*sin(theta2);
y3 = (t + rf*cos(theta3))*sin30;
x3 = -y3*tan60;
z3 = -rf*sin(theta3);
dnm = (y2-y1)*x3-(y3-y1)*x2;
w1 = y1*y1 + z1*z1;
w2 = x2*x2 + y2*y2 + z2*z2;
w3 = x3*x3 + y3*y3 + z3*z3;
% x = (a1*z + b1)/dnm
a1 = (z2-z1)*(y3-y1)-(z3-z1)*(y2-y1);
b1 = -((w2-w1)*(y3-y1)-(w3-w1)*(y2-y1))/2.0;
% y = (a2*z + b2)/dnm;
a2 = -(z2-z1)*x3+(z3-z1)*x2;
b2 = ((w2-w1)*x3 - (w3-w1)*x2)/2.0;
% a*z^2 + b*z + c = 0
a = a1*a1 + a2*a2 + dnm*dnm;

b = 2*(a1*b1 + a2*(b2-y1*dnm) - z1*dnm*dnm);
c = (b2-y1*dnm)*(b2-y1*dnm) + b1*b1 + dnm*dnm*(z1*z1 - re*re);
% discriminant
d = b*b - 4.0*a*c;
if (d > 0)
z0 = -0.5*(b+sqrt(d))/a
y0 = (a2*z0 + b2)/dnm
x0 = (a1*z0 + b1)/dnm
else
disp = 'non-existing point'
end

Reverse Kinematics Equation (Ters Kinematik Denklem)

% reverse kinemeatics solution from mzavatsky in website
% http://forums.trossenrobotics.com/tutorials/introduction-129/delta-robot-kinematics-3276/
% marmara üniversity engineering faculty mechanical engineering
% remzi şahinoğlu
% 18.04.2011

clear all
clc

% robot geometry
% (look at pics above for explanation)
e = 109.11920088; % base triangle side length
f = 143.76021703; % end effector triangle side length
re = 323.59252155; % rod length
rf = 133.09395178; % arm length
% trigonometric constants
sqrt3 = sqrt(3.0);
pi = 3.141592653;
sin120 = sqrt3/2.0;
cos120 = -0.5;
tan60 = sqrt3;
sin30 = 0.5;
tan30 = 1/sqrt3;

%*************** x y z bilgilerini buraya giriniz ***************
x0 = 0;
y0 = 0;
z0 = -270.69926935; % değer eksi olmalıdır çünkü z ekseni yukarı yönde pozitiftir

%*************** x y z bilgilerini buraya giriniz ***************
%********** theta 2
% inverse kinematics
% helper functions, calculates angle theta1 (for YZ-pane)
%int delta_calcAngleYZ(float x0, float y0, float z0, float &theta)
y1 = -0.5 * 0.57735 * f; % f/2 * tg 30
y01 = y0 -0.5 * 0.57735 * e; % shift center to edge

% z = a + b*y
a = (x0*x0 + y01*y01 + z0*z0 +rf*rf - re*re - y1*y1)/(2*z0);
b = (y1-y01)/z0;

% discriminant
d = -(a+b*y1)*(a+b*y1)+rf*(b*b*rf+rf);
if (d > 0)
	yj = (y1 - a*b - sqrt(d))/(b*b + 1); % choosing outer point
	zj = a + b*yj;
	theta_1 = 180.0*atan(-zj/(y1 - yj))/pi; % + ((yj>y1)?180.0:0.0); yj, y1 den küçükse 180 degilse 0 değerini çıkarır
		if (yj>y1)
			theta_2 = 180;
		else
			theta_2 = 0;
		end
	theta1 = theta_1 + theta_2
else
	disp= 'non-existing point'
end

%********** theta 2
x02 = x0*cos120 + y0*sin120;
y02 = y0*cos120 - x0*sin120;
z02 = z0;

%y1 = cos(120)*(-0.5 * 0.57735 * f);
y1 = -0.5 * 0.57735 * f; % f/2 * tg 30
y02 = y02 -0.5 * 0.57735 * e; % shift center to edge

% z = a + b*y
a = (x02*x02 + y02*y02 + z02*z02 +rf*rf - re*re - y1*y1)/(2*z02);
b = (y1-y02)/z02;

% discriminant
d = -(a+b*y1)*(a+b*y1)+rf*(b*b*rf+rf);
if (d > 0)
	yj = (y1 - a*b - sqrt(d))/(b*b + 1); % choosing outer point
	zj = a + b*yj;
	theta_1 = 180.0*atan(-zj/(y1 - yj))/pi; % + ((yj>y1)?180.0:0.0); yj, y1 den küçükse 180 degilse 0 değerini çıkarır
	if (yj>y1)
		theta_2 = 180;
	else
		theta_2 = 0;
	end
	theta2 = theta_1 + theta_2
else
	disp= 'non-existing point'
end

%************theta3
x03 = x0*cos120 - y0*sin120;
y03 = y0*cos120 + x0*sin120;
z03 = z0;
y1 = -0.5 * 0.57735 * f; % f/2 * tg 30
y03 = y03 -0.5 * 0.57735 * e; % shift center to edge

% z = a + b*y
a = (x03*x03 + y03*y03 + z03*z03 +rf*rf - re*re - y1*y1)/(2*z03);
b = (y1-y03)/z03;

% discriminant
d = -(a+b*y1)*(a+b*y1)+rf*(b*b*rf+rf);
if (d > 0)
	yj = (y1 - a*b - sqrt(d))/(b*b + 1); % choosing outer point
	zj = a + b*yj;
	theta_1 = 180.0*atan(-zj/(y1 - yj))/pi; % + ((yj>y1)?180.0:0.0); yj, y1 den küçükse 180 degilse 0 değerini çıkarır
	if (yj>y1)
		theta_2 = 180;
	else
		theta_2 = 0;
	end
	theta3 = theta_1 + theta_2
else
	disp= 'non-existing point'
end
Visual C#: Paralel Robot Yazılım

Bu kod tarafımdan yazılmıştır. Amacı delta robotun bilgisayar ile kontrolünü sağlamaktır. 6 farklı şekilde robot kontrolü sağlamaya izin verir. Mavi ekran robotun bilgisayar faresi ile kontrol edilmesi sağlar. Bilgisayar faresi mavi ekranın sınırları içerisine girdiğinde farenin ekranda bulunduğu xy posizyonu program tarafından okunup o an ki z ekseni değerine göre anlık olarak kinematik denklemden geçirilerek hesaplanan açı değerleri seri porttan gönderilir. Fare konumu her değiştiğinde bu işlem yapılır. Bu şekilde gerçek zamanlı olarak hareket ettirilebilr. Farenin sol tuşu ile robotun z ekseni +10mm sağ tuşu ile -10mm olarak hareket ettirilebilir. Farnin tekerlek tuşunada basılarak kıskaç açılıp kapanabilir.

Sağ üst köşedeki scrollbar lar ise kollar kinematik denklemden ve birbirinden bağımsız olarak hareket ettimeye yarar. Saü alt taraftaki xyz butonları 100mm kadar robotu hareket ettirir. Onun yanındaki nokta kontrol bloguna girelen xyz değerleri git tuşuna basılınca robot o konuma gider.
Ortadaki programlama blogu ise robotun hareketlerini kıskacın durumunu kaydet tuşuna basarak hafızaya alır. Birden fazla nokta berlileyip hafızaya alındıktan sonra çalış tuşuna basarak ilk noktadan en son noktaya doğru robotun otomatik kontrolünü yapabilirsiniz.

Önemli not olarak bu programda robot geometri kısmındaki değişkenleri kendi robotunuzun geometrisine göre değiştirmeniz gereklidir. Aynı şekilde 3d programında robotunuzun sıfır pozisyonundaki end-effectorun xyz konumu hassas olarak ölçülüp robot geometri bölümün altındaki sıfır posizyon bölümüne değerler girilmelidir.

Paralel Robot Yazılımı
Paralel Robot Yazılım
using System;
using System.Collections.Generic;
using System.ComponentModel;
using System.Data;
using System.Drawing;
using System.IO.Ports;
using System.Linq;
using System.Text;
using System.Windows.Forms;

namespace delta_robot_v1
{
	public partial class Form1 : Form
	{
		byte servo1,servo2,servo3,kiskac;
		float e, f, re, rf, x0, y0, z0, x02, x03, y1, y01, y02, y03, z02, z03, theta1, theta2, theta3, a, b, d, yj, zj;
		float t, dtr, y001, z1, z2, y2, x2, y3, x3, z3, dnm, w1, w2, w3, a1, b1, a2, b2, a0, b0, c0, d0;
		float pi=3.1415927F;
		string kiskac_txt;
		byte[] servo_pwm = new byte[200]; // 50 point veya işlem yapılabilir
		int i = 0, dongu;
		
		public Form1()
		{
			InitializeComponent();
			comboBox1.Items.Add("COM1");
			comboBox1.Items.Add("COM2");
			comboBox1.Items.Add("COM3");
			comboBox1.Items.Add("COM4");
			comboBox1.Items.Add("COM5");
			comboBox1.Items.Add("COM6");
			comboBox1.Text = "COM1";
			timer1.Enabled = false;
			
			if (serialPort1.IsOpen == true) // program başladıgında port acıksa kapat
			{
				serialPort1.Close();
			}
			
			x_pos.Enabled = false; // port kapalı ise kontrol butonlarını pasifle
			x_neg.Enabled = false;
			y_pos.Enabled = false;
			y_neg.Enabled = false;
			z_pos.Enabled = false;
			z_neg.Enabled = false;
			Kaydet_btn.Enabled = false;
			Sil_btn.Enabled = false;
			Calis_btn.Enabled = false;
			Dur_btn.Enabled = false;
			listBox1.Enabled = false;
			textBox_in_x.Enabled = false;
			textBox_in_y.Enabled = false;
			textBox_in_z.Enabled = false;
			checkBox_mouse.Enabled = false;
			kiskac_ac_btn.Enabled = false;
			sifir_poz_btn.Enabled = false;
			btn_git.Enabled = false;
			vScrollBar_1.Enabled = false;
			vScrollBar_2.Enabled = false;
			vScrollBar_3.Enabled = false;
			hScrollBar1_Timer.Enabled = false;
			// robot geometrisi için değişkenlerin atanması
			e = 109.12F; // end-effectorun üçgeninin kenar uzunluğu
			f = 346.41F; // base üçgeninin kenar uzunluğu
			rf = 133.09F; // arm uzunluğu
			re = 323.59F; // rod uzunluğu
			// robot ilk çalışmada sıfır posizyonuna gitmesi için
			x0 = 0;
			y0 = 0;
			z0 = -253.125F;
			hesapla_aci(); // ilk açılışta göstergelerin robotun sıfır pozisyonundaki
			hesapla_pwm(); // değerlerini alması için hesaplaması gerekir
			veriyi_gonder();
		}
		
		//**************************************************************************************//
		//************* GİRİLEN XYZ POZİSYON BİLGİSİNE GÖRE AÇI DEĞERLERİNİ HESAPLA ************//
		private void hesapla_aci()
		{
		//********** theta 1 ******************************************************//
			y1 = -0.5F * 0.57735F * f; // f/2 * tg 30
			y01 = y0 - 0.5F * 0.57735F * e; // shift center to edge
			// z = a + b*y
			a = (x0 * x0 + y01 * y01 + z0 * z0 + rf * rf - re * re - y1 * y1) / (2 * z0);
			b = (y1 - y01) / z0;
			// discriminant
			d = -(a + b * y1) * (a + b * y1) + rf * (b * b * rf + rf);
			if (d > 0)
			{
				yj = (y1 - a * b - (float)Math.Sqrt(d) / (b * b + 1)); // choosing outer point
				zj = a + b * yj;
				theta1 = 180.0F * (float)Math.Atan(-zj / (y1 - yj)) / pi + ((yj > y1) ? 180.0F : 0.0F); // yj, y1 den küçükse 180; degilse 0 değerini çıkarır
			}
			else
			{
				no_point();
			}
			
			//********** theta 2 ******************************************************//
			x02 = x0 * (float)Math.Cos(120 * pi / 180) + y0 * (float)Math.Sin(120 * pi / 180);
			y02 = y0 * (float)Math.Cos(120 * pi / 180) - x0 * (float)Math.Sin(120 * pi / 180);
			z02 = z0;
			//y1 = cos(120)*(-0.5 * 0.57735 * f);
			y1 = -0.5F * 0.57735F * f; // f/2 * tg 30
			y02 = y02 - 0.5F * 0.57735F * e; // shift center to edge
			// z = a + b*y
			a = (x02 * x02 + y02 * y02 + z02 * z02 + rf * rf - re * re - y1 * y1) / (2 * z02);
			b = (y1 - y02) / z02;
			// discriminant
			d = -(a + b * y1) * (a + b * y1) + rf * (b * b * rf + rf);
			if (d > 0)
			{
				yj = (y1 - a * b - (float)Math.Sqrt(d)) / (b * b + 1); // choosing outer point
				zj = a + b * yj;
				theta2 = 180.0F * (float)Math.Atan(-zj / (y1 - yj)) / pi + ((yj > y1) ? 180.0F : 0.0F); //yj, y1 den küçükse 180; degilse 0 değerini çıkarır
			}
			else
			{
				no_point();
			}
			
			//********** theta 3 ******************************************************//
			x03 = x0 * (float)Math.Cos(120 * pi / 180) - y0 * (float)Math.Sin(120 * pi / 180);
			y03 = y0 * (float)Math.Cos(120 * pi / 180) + x0 * (float)Math.Sin(120 * pi / 180);
			z03 = z0;
			y1 = -0.5F * 0.57735F * f; // f/2 * tg 30
			y03 = y03 - 0.5F * 0.57735F * e; // shift center to edge
			// z = a + b*y
			a = (x03 * x03 + y03 * y03 + z03 * z03 + rf * rf - re * re - y1 * y1) / (2 * z03);
			b = (y1 - y03) / z03;
			// discriminant
			d = -(a + b * y1) * (a + b * y1) + rf * (b * b * rf + rf);
			if (d > 0)
			{
				yj = (y1 - a * b - (float)Math.Sqrt(d)) / (b * b + 1); // choosing outer point
				zj = a + b * yj;
				theta3 = 180.0F * (float)Math.Atan(-zj / (y1 - yj)) / pi + ((yj > y1) ? 180.0F : 0.0F); //yj, y1 den küçükse 180; degilse 0 değerini çıkarır
			}
			else
			{
				no_point();
			}
		}
		
		//******************* ÇALIŞMA UZAYINI DIŞINDA BİR NOKTA TANIMLANDIĞINDA ****************//
		private void no_point()
		{
			MessageBox.Show("Hata: Çalışma alanı dışında bir nokta tanımlanmış");
		}
		
		//**************************************************************************************//
		//*************** GİRİLEN AÇI BİLGİSİNDEN POSİZYON BİLGİSİNİ HESAPLAMA *****************//
		private void hesapla_pozisyon() // hata var çözüm henüz bulunamadı
		{
			// theta değerleri radyan olarak girilmelidir
			//theta1 = theta1 * pi / 180;
			//theta2 = theta2 * pi / 180;
			//theta3 = theta3 * pi / 180;
			t = (f - e) * (float)Math.Tan(30) / 2;
			dtr = pi / 180;
			y001 = -(t + rf * (float)Math.Cos(theta1));
			z1 = -rf * (float)Math.Sin(theta1);
			y2 = (t + rf * (float)Math.Cos(theta2)) * (float)Math.Sin(30);
			x2 = y2 * (float)Math.Tan(60);
			z2 = -rf * (float)Math.Sin(theta2);
			y3 = (t + rf * (float)Math.Cos(theta3)) * (float)Math.Sin(30);
			x3 = -y3 * (float)Math.Tan(60);
			z3 = -rf * (float)Math.Sin(theta3);
			dnm = (y2 - y001) * x3 - (y3 - y001) * x2;
			w1 = y001 * y001 + z1 * z1;
			w2 = x2 * x2 + y2 * y2 + z2 * z2;
			w3 = x3 * x3 + y3 * y3 + z3 * z3;
			// x = (a1*z + b1)/dnm
			a1 = (z2 - z1) * (y3 - y001) - (z3 - z1) * (y2 - y001);
			b1 = -((w2 - w1) * (y3 - y001) - (w3 - w1) * (y2 - y001)) / 2;
			// y = (a2*z + b2)/dnm;
			a2 = -(z2 - z1) * x3 + (z3 - z1) * x2;
			b2 = ((w2 - w1) * x3 - (w3 - w1) * x2) / 2;
			// a*z^2 + b*z + c = 0
			a0 = a1 * a1 + a2 * a2 + dnm * dnm;
			b0 = 2 * (a1 * b1 + a2 * (b2 - y1 * dnm) - z1 * dnm * dnm);
			c0 = (b2 - y001 * dnm) * (b2 - y001 * dnm) + b1 * b1 + dnm * dnm * (z1 * z1 - re * re);
			// discriminant
			d0 = b0 * b0 - 4 * a0 * c0;
			if (d0 > 0)
			{
			z0 = -0.5F * (b + (float)Math.Sqrt(d)) / a0;
			y0 = (a2 * z0 + b2) / dnm;
			x0 = (a1 * z0 + b1) / dnm;
			}
			else
			{ no_point(); }
		}
		
		//**************************************************************************************//
		//************ HESAPLANAN AÇI DEĞERLERİNE GÖRE PWM DUTY SÜRELERİNİ HESAPLA *************//
		private void hesapla_pwm()
		{
			if (143.333F + 1.0833 * theta1 < 230)
				servo1 = Convert.ToByte(143.333F + 1.0833 * theta1);
			else
				servo1 = 230;
				
			if (143.333F + 1.0833 * theta2 < 230)
				servo2 = Convert.ToByte(143.333F + 1.0833 * theta2);
			else
				servo2 = 230;
				
			if (143.333F + 1.0833 * theta3 < 230)
				servo3 = Convert.ToByte(143.333F + 1.0833 * theta3);
			else
				servo3 = 230;
		}
		
		//**************************************************************************************//
		//*************** HESAPLANAN AÇI ve POZİSYON BİLGİLERİNİ GÖSTERGEYE YAZ ****************//
		private void gostergeye_yaz()
		{
			// pozisyon bilgilerini göstergeye yaz
			label_xpos.Text = Convert.ToString(x0);
			label_ypos.Text = Convert.ToString(y0);
			label_zpos.Text = Convert.ToString(z0);
			// açı bilgilerini açı bilgisi göstergesine yaz
			label16.Text = Convert.ToString(theta1);
			label17.Text = Convert.ToString(theta2);
			label18.Text = Convert.ToString(theta3);
			// pwm duty sürelerini göstergeye yaz
			label20.Text = servo1.ToString();
			label21.Text = servo2.ToString();
			label22.Text = servo3.ToString();
		}
		
		//**************************************************************************************//
		//**************************** BİLGİYİ SERİ PORTTAN GÖNDER *****************************//
		private void veriyi_gonder()
		{
			if (serialPort1.IsOpen == true)
			{
				serialPort1.Write(new byte[] { servo1, servo2, servo3, kiskac }, 0, 4);
			}
		}
		//**************************************************************************************//
		//************************ SERİ PORTU AÇ 9600 BAUD RATE HIZI ***************************//
		private void baglan_Click(object sender, EventArgs e)
		{
			if (serialPort1.IsOpen == false)
			{
				comboBox1.Enabled = false;
				serialPort1.Open(); // port aç
				baglan.Text = "Bağlantıyı Kes";
				baglan.BackColor = Color.Green;
				x_pos.Enabled = true; // port kapalı ise kontrol butonlarını aktif et
				x_neg.Enabled = true;
				y_pos.Enabled = true;
				y_neg.Enabled = true;
				z_pos.Enabled = true;
				z_neg.Enabled = true;
				Kaydet_btn.Enabled = true;
				Sil_btn.Enabled = true;
				Calis_btn.Enabled = true;
				Dur_btn.Enabled = true;
				listBox1.Enabled = true;
				textBox_in_x.Enabled = true;
				textBox_in_y.Enabled = true;
				textBox_in_z.Enabled = true;
				checkBox_mouse.Enabled = true;
				kiskac_ac_btn.Enabled = true;
				sifir_poz_btn.Enabled = true;
				btn_git.Enabled = true;
				vScrollBar_1.Enabled = true;
				vScrollBar_2.Enabled = true;
				vScrollBar_3.Enabled = true;
				hScrollBar1_Timer.Enabled = true;
			}
			else
			{
				comboBox1.Enabled = true;
				serialPort1.Close(); // port kapa
				baglan.Text = "Bağlan";
				baglan.BackColor = Color.Red;
				x_pos.Enabled = false; // port kapalı ise kontrol butonlarını pasifle
				x_neg.Enabled = false;
				y_pos.Enabled = false;
				y_neg.Enabled = false;
				z_pos.Enabled = false;
				z_neg.Enabled = false;
				Kaydet_btn.Enabled = false;
				Sil_btn.Enabled = false;
				Calis_btn.Enabled = false;
				Dur_btn.Enabled = false;
				listBox1.Enabled = false;
				textBox_in_x.Enabled = false;
				textBox_in_y.Enabled = false;
				textBox_in_z.Enabled = false;
				checkBox_mouse.Enabled = false;
				kiskac_ac_btn.Enabled = false;
				sifir_poz_btn.Enabled = false;
				btn_git.Enabled = false;
				vScrollBar_1.Enabled = false;
				vScrollBar_2.Enabled = false;
				vScrollBar_3.Enabled = false;
				hScrollBar1_Timer.Enabled = false;
			}
		}
		
		//**************************************************************************************//
		//********************* EKSEN KONTROL BUTONLARI X-Y-Z ve KISKAC ************************//
		private void x_pos_Click(object sender, EventArgs e)
		{
			x0 = x0 + 10;
			hesapla_aci();
			hesapla_pwm();
			gostergeye_yaz();
			veriyi_gonder();
		}
		
		private void x_neg_Click(object sender, EventArgs e)
		{
			x0 = x0 - 10;
			hesapla_aci();
			hesapla_pwm();
			gostergeye_yaz();
			veriyi_gonder();
		}
		
		private void y_pos_Click(object sender, EventArgs e)
		{
			y0 = y0 + 10;
			hesapla_aci();
			hesapla_pwm();
			gostergeye_yaz();
			veriyi_gonder();
		}

		private void y_neg_Click(object sender, EventArgs e)
		{
			y0 = y0 - 10;
			hesapla_aci();
			hesapla_pwm();
			gostergeye_yaz();
			veriyi_gonder();
		}

		private void z_pos_Click(object sender, EventArgs e)
		{
			z0 = z0 + 10;
			hesapla_aci();
			hesapla_pwm();
			gostergeye_yaz();
			veriyi_gonder();
		}

		private void z_neg_Click(object sender, EventArgs e)
		{
			z0 = z0 - 10;
			hesapla_aci();
			hesapla_pwm();
			gostergeye_yaz();
			veriyi_gonder();
		}

		//********************************* KISKACI AC KAPAT ***********************************//
		private void kiskac_ac_btn_Click(object sender, EventArgs e)
		{
			if (kiskac_ac_btn.Text == "Kıskaç aç")
			{
				kiskac_ac_btn.Text = "Kıskaç kapat";
				kiskac = 151;
				veriyi_gonder();
			}
			else
			{
				kiskac_ac_btn.Text = "Kıskaç aç";
				kiskac = 150;
				veriyi_gonder();
			}
		}
		
		//**************************************************************************************//
		//*************************** ROBOTU SIFIR POZİSYONUNA GETİR ***************************//
		private void sifir_poz_btn_Click(object sender, EventArgs e)
		{
			kiskac_ac_btn.Text = "Kıskaç kapalı";
			vScrollBar_1.Value = 150;
			vScrollBar_2.Value = 150;
			vScrollBar_3.Value = 150;
			kiskac = 150;
			x0 = 0;
			y0 = 0;
			z0 = -253.125F;
			hesapla_aci();
			hesapla_pwm();
			gostergeye_yaz();
			veriyi_gonder();
		}
		
		//**************************************************************************************//
		//****************** MOUSE İLE KONTROLÜ MODU - SÜRÜKLEME *******************************//
		private void pictureBox1_MouseMove(object sender, MouseEventArgs e)
		{
			Point nokta = Cursor.Position;
			if (checkBox_mouse.Checked == true)
			{
				x0 = (nokta.X - 208);
				y0 = (nokta.Y - 234);
				hesapla_aci();
				hesapla_pwm();
				veriyi_gonder();
				gostergeye_yaz();
			}
		}
				
		//**************************************************************************************//
		//****************** MOUSE İLE KONTROLÜ MODU - BUTON TIKLAMA ***************************//
		private void pictureBox1_MouseClick(object sender, MouseEventArgs e)
		{
			if (checkBox_mouse.Checked == true)
			{
				if (e.Button == MouseButtons.Left)
					//label_zpos.Text = "L";
					z0 = z0 + 10;
				else if (e.Button == MouseButtons.Right)
					z0 = z0 - 10;
				else if (e.Button == MouseButtons.Middle)
					if (kiskac == 150) // tekerleğe tıklanınca kıskac açıksa kapat, kapalı ise aç
					{ kiskac = 151; }
					else
					{ kiskac = 150; }
			}
		}
		
		//**************************************************************************************//
		//********************** SERVO MOTOR KONTROL SCROLL BARLARI ****************************//
		private void vScrollBar_1_Scroll(object sender, ScrollEventArgs e)
		{
			label16.Text = Convert.ToString(132.31 - (0.9231 * vScrollBar_1.Value));
			//hesapla_pozisyon(); // hatalı hesaplama yapıyor
			//gostergeye_yaz();
			servo1 = Convert.ToByte(vScrollBar_1.Value);
			serialPort1.Write(new byte[] { servo1, servo2, servo3, kiskac }, 0, 4);
		}
		
		private void vScrollBar_2_Scroll(object sender, ScrollEventArgs e)
		{
			label17.Text = Convert.ToString(132.31 - (0.9231 * vScrollBar_2.Value));
			servo2 = Convert.ToByte(vScrollBar_2.Value);
			// veriyi buradan gönder
			serialPort1.Write(new byte[] { servo1, servo2, servo3, kiskac }, 0, 4);
		}
		
		private void vScrollBar_3_Scroll(object sender, ScrollEventArgs e)
		{
			label18.Text = Convert.ToString(132.31 - (0.9231 * vScrollBar_3.Value));
			servo3 = Convert.ToByte(vScrollBar_3.Value);
			// veriyi buradan gönder
			serialPort1.Write(new byte[] { servo1, servo2, servo3, kiskac }, 0, 4);
		}
		
		//**************************************************************************************//
		//********************** GİRİLEN XYZ BİLGİSİNE GİT BUTONU */****************************//
		private void btn_git_Click(object sender, EventArgs e)
		{
			x0 = Convert.ToInt16(textBox_in_x.Text);
			y0 = Convert.ToInt16(textBox_in_y.Text);
			z0 = Convert.ToInt16(textBox_in_z.Text);
			hesapla_aci();
			hesapla_pwm();
			gostergeye_yaz();
			veriyi_gonder();
		}
		
		//*************************** PROGRAMLAMA KONTROL **************************************//
		private void Kaydet_btn_Click(object sender, EventArgs e)
		{
			if (kiskac == 151)
			{ kiskac_txt = "açık"; }
			else
			{ kiskac_txt = "kapalı"; }
			listBox1.Items.Add("X:" + Convert.ToString(x0) + ", Y:" + Convert.ToString(y0) + ", Z:" + Convert.ToString(z0) + ", K:" + kiskac_txt);
			// servo pwm bilgilerini kaydet
			i = i + 1;
			servo_pwm[i] = servo1;
			i = i + 1;
			servo_pwm[i] = servo2;
			i = i + 1;
			servo_pwm[i] = servo3;
			i = i + 1;
			servo_pwm[i] = kiskac;
		}
		
		private void Sil_btn_Click(object sender, EventArgs e)
		{
			listBox1.Items.Remove(listBox1.SelectedItem);
			if (i > 0)
			{
				servo_pwm[i] = 0;
				i = i - 1;
				servo_pwm[i] = 0;
				i = i - 1;
				servo_pwm[i] = 0;
				i = i - 1;
				servo_pwm[i] = 0;
				i = i - 1;
			}
			else
			{ i = 0; }
		}

		private void Calis_btn_Click(object sender, EventArgs e)
		{
			Kaydet_btn.Enabled = false;
			Sil_btn.Enabled = false;
			timer1.Enabled = true;
			dongu = i;
			i = 0;
		}
		
		private void timer1_Tick(object sender, EventArgs e)
		{
			if (i < dongu)
			{
				i = i + 1;
				servo1 = servo_pwm[i];
				i = i + 1;
				servo2 = servo_pwm[i];
				i = i + 1;
				servo3 = servo_pwm[i];
				i = i + 1;
				kiskac = servo_pwm[i];
				gostergeye_yaz();
				veriyi_gonder();
			}
			else
			{
				timer1.Enabled = false;
				Kaydet_btn.Enabled = true;
				Sil_btn.Enabled = true;
			}
		}
		
		private void Dur_btn_Click(object sender, EventArgs e)
		{
			timer1.Enabled = false;
			Kaydet_btn.Enabled = true;
			Sil_btn.Enabled = true;
		}
		
		private void hScrollBar1_Timer_Scroll(object sender, ScrollEventArgs e)
		{
			timer1.Interval = hScrollBar1_Timer.Value;
		}
		
		private void Form1_FormClosed(object sender, FormClosedEventArgs e)
		{
			timer1.Enabled = false;
			if (serialPort1.IsOpen == true) // program kapatıldıgında port acıksa kapat
			{
				serialPort1.Close();
			}
		}
		
		private void comboBox1_SelectedIndexChanged(object sender, EventArgs e)
		{
			serialPort1.PortName = comboBox1.Text;
		}
	}
}

Bir sonraki uygulamamızda Parelel robotumuzu step motor ile nasıl tahrik edilir öğreneceğiz.

Bunları da sevebilirsiniz

Ebu’l İz İsmail İbni Rezzaz El-Cezeri Kimdir

Remzi Şahinoğlu 0

Paralel Robot DC Redüktörlü Motor Tahrikli Tasarımı – 8

Remzi Şahinoğlu 0

Paralel Robot Elektronik Devre Step Motor Tasarımı – 6

Remzi Şahinoğlu 0

Bir cevap yazın

E-posta hesabınız yayımlanmayacak.

This site uses Akismet to reduce spam. Learn how your comment data is processed.