hmm...masalah penyesuaian beban itu yang saya masih belum bisa menghitung
hubungan antara kebutuhan (dalam hal ini beban n kecepatan) dengan spesifikasi
motor (jumlah lilitan, jenis kabel, dll). tapi sebenarnya pada praktiknya ga
sampe 10A koq mas...sebenernya tegangan kerja normal motor ga lebih dari 3A.
cuma arusnya jadi melonjak waktu ganti arah. n sudah diperhitungkan juga
masalah konversi gear dan belt yang dipakai. cuma tetep ga pake gearbox karena
kami anggap membuat motor jadi terlalu lambat. tapi kemaren temen2 juga sudah
berhasil sama rangkaian drivernya. ternyata masalah selama ini adalah kurang
teliti terhadap wiring. sekarang temen2 agak bingung masalah programnya, karena
sekarang untuk sensor garis memakai 8sensor sekaligus (tujuannya supaya lebih
smooth), tetapi karena motornya ga pake gearbox, jika PWMnya diberi nilai 0,
motor ga langsung berhenti masih ada lembamnya.
garis besar ide programnya sbb:
dengan asumsi arah ke2 motor selalu maju, posisi sensor paling kiri adalah LSB,
kecepatan normal dari motor kanan dan motor kiri adalah KA dan KI, & out
adalah flag untuk menandai posisi terakhir robot (kanan atau kiri garis).
////////////////////////////////////////////////////////////////////////////////////////////////////
switch (sensor)
{
case 0b11111110:
pwm_kanan = KA - (5*5); pwm_kiri = KI + (5*5); out = 1; break;
case 0b11111100:
pwm_kanan = KA - (4*5); pwm_kiri = KI + (4*5); out = 1; break;
case 0b11111101:
pwm_kanan = KA - (3*5); pwm_kiri = KI + (3*5); out = 1; break;
case 0b11111001:
pwm_kanan = KA - (3*5); pwm_kiri = KI + (3*5); out = 1; break;
case 0b11111011:
pwm_kanan = KA - (2*5); pwm_kiri = KI + (2*5); out = 1; break;
case 0b11110011:
pwm_kanan = KA - (2*5); pwm_kiri = KI + (2*5); out = 1; break;
case 0b11110111:
pwm_kanan = KA - (1*5); pwm_kiri = KI + (1*5); break;
case 0b11100111:
pwm_kanan = KA; pwm_kiri = KI; break;
case 0b11101111:
pwm_kanan = KA + (1*5); pwm_kiri = KI - (1*5); out = 0; break;
case 0b11001111:
pwm_kanan = KA + (2*5); pwm_kiri = KI - (2*5); out = 0; break;
case 0b11011111:
pwm_kanan = KA + (2*5); pwm_kiri = KI - (2*5); out = 0; break;
case 0b10011111:
pwm_kanan = KA + (3*5); pwm_kiri = KI - (3*5); out = 0; break;
case 0b10111111:
pwm_kanan = KA + (3*5); pwm_kiri = KI - (3*5); out = 0; break;
case 0b00111110:
pwm_kanan = KA + (4*5); pwm_kiri = KI - (4*5); out = 0; break;
case 0b01111111:
pwm_kanan = KA + (5*5); pwm_kiri = KI - (5*5); out = 0; break;
case 0b00000000:
pwm_kanan = 0; pwm_kiri = 0; break;
case 0b11111111:
if(out)
{
pwm_kanan = 0; pwm_kiri = KI + (5*5); break;
}
else
{
pwm_kanan = KA + (5*5); pwm_kiri = 0; break;
}
}
////////////////////////////////////////////////////////////////////////////////////////////////////
begitulah kurang lebih potongan programnya. namun hasilnya masih kasar dan
sering melenceng keluar garis. selama ini kami hanya main2 nilai PWM kanan dan
kirinya.
terima kasih bila ada saran atau perbaikan terhadap program ini. supaya team
KRI STIKOM bisa berlaga lagi di kontes nasional....!!!
MAD
Send instant messages to your online friends http://uk.messenger.yahoo.com