Robotik sistemlerde hassas hareket kontrolü, birçok uygulamanın temelini oluşturur. Bu kontrolün sağlanmasında motor sürme teknikleri ve geri beslemeli kontrol algoritmaları kritik öneme sahiptir. Bu yazıda, robotik kodlama örnekleri üzerinden motor sürme ve PID (Oransal-İntegral-Türev) kontrol kavramlarını inceleyeceğiz.
Aşağıdaki örnek kod, bir DC motoru H-köprüsü kullanarak sürmeyi ve PWM ile hızını kontrol etmeyi göstermektedir:
NOT: Bu örnek kod sadece temsilidir. Gerçek uygulamalarda motor sürücü devresinin özelliklerine ve motorun gereksinimlerine göre uyarlanmalıdır.
c++ // Motor pin tanımlamaları int enablePin = 9; // PWM kontrol pini int in1Pin = 8; // H-köprüsü giriş 1 int in2Pin = 7; // H-köprüsü giriş 2 void setup() { // Pinleri çıkış olarak ayarla pinMode(enablePin, OUTPUT); pinMode(in1Pin, OUTPUT); pinMode(in2Pin, OUTPUT); } void loop() { // Motoru ileri yönde düşük hızda sür digitalWrite(in1Pin, HIGH); digitalWrite(in2Pin, LOW); analogWrite(enablePin, 100); // PWM değeri (0-255 arası) delay(2000); // Motoru durdur digitalWrite(in1Pin, LOW); digitalWrite(in2Pin, LOW); analogWrite(enablePin, 0); delay(1000); // Motoru geri yönde yüksek hızda sür digitalWrite(in1Pin, LOW); digitalWrite(in2Pin, HIGH); analogWrite(enablePin, 200); delay(2000); // Motoru durdur digitalWrite(in1Pin, LOW); digitalWrite(in2Pin, LOW); analogWrite(enablePin, 0); delay(1000); }PID kontrol, bir sistemin çıkışını istenen değere (setpoint) yaklaştırmak için kullanılan geri beslemeli bir kontrol algoritmasıdır. Üç temel bileşenden oluşur:
PID kontrol algoritmasının matematiksel ifadesi aşağıdaki gibidir:
$u(t) = K_p e(t) + K_i \int_{0}^{t} e(\tau) d\tau + K_d \frac{de(t)}{dt}$
Burada:
Aşağıdaki örnek kod, bir DC motorun hızını PID kontrol algoritması kullanarak kontrol etmeyi göstermektedir:
NOT: Bu örnek kod, temel bir uygulamayı göstermektedir. Gerçek sistemlerde PID parametrelerinin (Kp, Ki, Kd) sistemin dinamiklerine göre ayarlanması (tuning) gereklidir.
c++ // Motor pin tanımlamaları (aynı) int enablePin = 9; int in1Pin = 8; int in2Pin = 7; // Encoder pin tanımlamaları int encoderPinA = 2; int encoderPinB = 3; // PID parametreleri double Kp = 0.5; double Ki = 0.1; double Kd = 0.01; // Setpoint (istenilen hız) double setpoint = 100; // Değişkenler double error, lastError, integral, derivative; volatile int encoderCount = 0; double currentSpeed; void setup() { // Pinleri ayarla (aynı) pinMode(enablePin, OUTPUT); pinMode(in1Pin, OUTPUT); pinMode(in2Pin, OUTPUT); pinMode(encoderPinA, INPUT_PULLUP); pinMode(encoderPinB, INPUT_PULLUP); // Encoder kesmesi attachInterrupt(digitalPinToInterrupt(encoderPinA), updateEncoder, CHANGE); // Seri haberleşmeyi başlat Serial.begin(9600); } void loop() { // Hızı hesapla (örneğin, encoder okumalarına göre) currentSpeed = encoderCount; // Basit örnek için encoderCount = 0; // Sayacı sıfırla // PID hesaplamaları error = setpoint - currentSpeed; integral += error; derivative = error - lastError; // Kontrol sinyalini hesapla double output = Kp * error + Ki * integral + Kd * derivative; // Kontrol sinyalini sınırlayın (0-255 arası) output = constrain(output, 0, 255); // Motoru sür digitalWrite(in1Pin, HIGH); digitalWrite(in2Pin, LOW); analogWrite(enablePin, output); // Hata ve son hatayı güncelle lastError = error; // Seri port üzerinden verileri gönder Serial.print("Setpoint: "); Serial.print(setpoint); Serial.print(", Current Speed: "); Serial.print(currentSpeed); Serial.print(", Output: "); Serial.println(output); // Kısa bir gecikme delay(10); } // Encoder kesme fonksiyonu void updateEncoder() { // Encoder sinyallerine göre sayacı artır veya azalt if (digitalRead(encoderPinA) == digitalRead(encoderPinB)) { encoderCount++; } else { encoderCount--; } }Bu yazıda, robotik sistemlerde hareket kontrolü için temel motor sürme tekniklerini ve PID kontrol algoritmasını inceledik. Verilen kod örnekleri, bu kavramların pratikte nasıl uygulanabileceğine dair bir fikir vermektedir. Unutmayın ki, gerçek dünya uygulamalarında sistemin özelliklerine ve gereksinimlerine göre daha karmaşık kontrol stratejileri ve algoritmaları gerekebilir.
