16 Aralık 2015 Çarşamba

PIC18F452 CCS C - Yazılımsal PWM ile Servo Motor Sürme

Bu yazımda daha önce Arduino kullanarak sürdüğümüz servo motoru aynı şekilde PIC ile yapmaya çalışacağız. Bildiğiniz gibi Arduino, kütüphaneleri sayesinde  işimizi çok kolaylaştırmakta fakat aynı durumu PIC için söyleyemeyeceğim. Kütüphane kullanmadan yazılımsal PWM ile servoyu CCS C kullanarak kontrol etmeye çalışacağız.

Öncelikle servo motorlar hakkında detaylı bilgi için Arduino ile yaptığımız uygulamanın yazısını okumanız yeterli olacaktır.Bağlantı linki;

http://arduinotik.blogspot.com.tr/2014/05/arduino-pwm-ile-servo-motor-surme.html




 
Yazılımsal PWM oluşturma mantığımız soldaki gifte görüldüğü gibi olacak. Toplamda 20 ms'lik bir sinyal üretip 0 Derece için 1ms, 180 Derece için 2 ms lik bir duty cycle oluşturacağız. En azından teorik olarak. Çünkü kullandığım servo motor (SG90), 550us-2550 us'lik duty cycle ile çalışmakta. Tabii ki sinyal genişliğimiz yine 20ms olacak.





Yazılım kodlarını atmadan önce yaptığım işlemlerden kısaca bahsetmek istiyorum. Öncelikle servo motor için aç-kapa mantığı ile (led yakıp söndürme ile aynı) bir fonksiyon oluşturdum. Bu açma-kapama süreleri arasında kullandığım gecikme zamanlarını da potansiyometreden okuduğum adc değerleri ile belirledim. Yani servo motor potansiyometreden okundan adc değerine göre açıyı belirleyip konum alacak.

Neden donanımsal PWM kullanmadım ? Çünkü PIC ile 50 Hz'lik donanımsal PWM sinyali oluşturamıyorum. Bu yüzden yazılımsal PWM'i tercih ettim.




#include <main.h>
#include <flexy_lcd.c>
#use fast_io(a)
#use fast_io(d)

unsigned long int i=0,aci=0;

void servo(unsigned long int b,c)
{
 output_high(pin_d7);
 delay_us(550+b);  // PWM Dolu Kısım
 output_low(pin_d7);
 delay_us(19450-b);  //PWM Dolu Kısmı 20 ms'e tamamlayacak kısım
 printf(lcd_putc,"\fAci = %u Derece",c);
 continue;
}

void main()
{ set_tris_a(0x01);
 set_tris_d(0x00);
 output_d(0x00);
 setup_adc(adc_clock_div_16);
 setup_adc_ports(AN0);
 set_adc_channel(0);
 lcd_init();
 while(1)
 {
  i=read_adc();
  aci=i*2/11.1;
  i=i*2;
  servo(i,aci);
 } 
}


LCD kütüphanenizi kendinize göre belirlemeyi unutmayın.

Potansiyometrenin orta ucunuz A0 pinine, Servo motorun PWM ucunu da D7 pinine bağladım.

Ayrıca Servo motoru toprak uçları aynı olmak şartıyla başka bir kaynaktan beslemenizde gerekiyor.

SG90 Tower Pro Servo Motoru  550us-2550us arasında çalışıyor. Yani her şekilde en az 550 mikrosaniyelik bir PWM sinyalimiz olacak ve açı eklemelerimiz bu sürenin üzerine olmalı. En fazla da 2550 mikrosaniye.

Kabaca bir hesapla 10 bitlik ADC kullanarak 1023 değerini elde ettiğimizde PWM sinyalimizin doluluğun 2550 mikro saniye olması gerekiyor. Yani,

550+ADC.X=2550  denkleminde ADC yerine 1023 koyarsak,

X= 1,955 çıkıyor. delay_us fonksiyonunu kullanırken içinin tam sayı olması için bu değeri 2'ye yuvarladım. Ondalıklı değerlerde sıkıntı çıkıyor çünkü.

LCD'de açıyı göstermek için de, servonun her 1 derecelik dönüşünün 11.1 us olduğunu hesapladım. Dolayısıyla 2 ile çarptığım değeri 11.1'e böldüğümde açı değeri çıkıyor.

(2550-550) / 180 = 11.1 us

void servo fonksiyonu ile de  minimum 550us'lik lojik-1 ve bunu 20000us (20ms) ye tamamlayacak lojik-0  (20000-550=19450 us) değelerinden; lojik-1'e  2 ile çarptığımız ADC değerini ekler, lojik-0'dan da bu değeri çıkarırsak servomuzu sürebiliriz. 
PWM sinyalimizin frekansının  her zaman 50Hz, periyodunun da 20ms olduğuna dikkat ediniz.

Bu arada kullanmış olduğum






header dosyasının kodları da aşağıda ve siz direkt yazılımın başına ekleyebilirsiniz dilerseniz. Ya da benim kullandığım gibi ana programın olduğu klasöre atıp include edebilirsiniz.



#include <18F452.h>
#device adc=10

#FUSES NOWDT                  //No Watch Dog Timer
#FUSES HS                     //High speed Osc (> 4mhz for PCM/PCH) (>10mhz for PCD)
#FUSES NOPUT                  //No Power Up Timer
#FUSES NOPROTECT              //Code not protected from reading
#FUSES NODEBUG                //No Debug mode for ICD
#FUSES NOBROWNOUT             //No brownout reset
#FUSES NOLVP                  //No low voltage prgming, B3(PIC16) or B5(PIC18) used for I/O
#FUSES NOCPD                  //No EE protection
#FUSES NOWRT                  //Program memory not write protected
#FUSES RESERVED               //Used to set the reserved FUSE bits

#use delay(clock=20000000)

Uygulamanın videosu;



6 yorum:

  1. Verdiğn bilgiler için teşekkür ederim.Fakat bu fonksiyon ekleme ve çıkarma yaptığın yerleri anlamadım.Yardım(lar)ını bekliyorum.

    YanıtlaSil
    Yanıtlar
    1. Fonksiyon içerisinde "b" değişkenine ne yazarsanız yazın(en fazla 1450 olmak şartıyla), pin_d7'nin toplamda kapalı ve açık kalma süresi hep 20ms oluyor. Yani periyodu sabit 20ms olan bir pwm sinyali üretmiş oluyoruz. Servoda bu şekilde sürülüyor. ( 1ms ON-19ms OFF, 0 derece ; 2ms ON-18ms OFF; 180 derece )

      Sil
  2. Bu yorum yazar tarafından silindi.

    YanıtlaSil

  3. servo(i,aci);


    void servo(unsigned long int b,c)

    Burada i değeri b'ye eşittir doğru mu ?

    YanıtlaSil
    Yanıtlar
    1. Evet doğrudur b değerine, i değişkeninin değerini atıyorsunuz.

      Sil
  4. Merhaba,bu kodu kullanarak 4 farklı kanaldan analog bilgi okuyup bunları servolara gönderince hareketlerinde ağırlaşma oluyor.Sence sorun ne olabilir? İstersen sana program ve devreyi mail atabilirim.

    YanıtlaSil