Adafruit IR (Infrared) Receiver Sensor - TSOP38238
1
Resistor 1k ohm
1
Resistor 2.2k ohm
1
Baterai LiPo 7.4 V / 500 mAh
1
Alat dan Mesin yang Diperlukan
Printer 3D (generik)
Pemolot (generik)
Aplikasi dan Layanan Online
Arduino IDE
Tentang Proyek Ini
Pengantar
Saya ingin membuat robot berjalan empat kaki, lebih dalam gaya "mamalia" daripada "laba-laba" atau "serangga" biasa. Inspirasi datang dari robot Boston Dynamics yang terkenal dan robot penelitian empat kaki lainnya. Membuat robot seperti ini cukup menantang karena dengan mudah terbalik karena titik gravitasi yang tinggi dan kaki di bawah tubuh daripada menyebar ke sudut.
Tujuannya adalah untuk membuat robot murah, menggunakan Arduino dan servo mikro berbiaya rendah. Solusi ini tentu memiliki keterbatasan. Tidak boleh diharapkan sempurna tetapi saya telah berhasil membuat beberapa robot yang dapat melakukan perilaku berjalan seperti yang dijelaskan dalam film ini. Dan melakukan yang terbaik yang bisa dilakukan dengan anggaran yang sangat kecil adalah tantangan dan mungkin sesuatu yang tidak pernah dihadapi oleh para anggota proyek penelitian yang dana berlimpah. :)
Dari awal teridentifikasi bahwa studi kinematika terbalik (IK) diperlukan untuk melakukannya dengan benar. Kode memiliki serangkaian persamaan untuk menghitung sudut sendi berdasarkan gerakan kaki yang diinginkan. Ini dapat digunakan lebih lanjut dalam fungsi untuk beberapa tugas yang berulang seperti melakukan gerakan tubuh (menggerakkan semua empat kaki ke arah yang berlawanan) dan melakukan gerakan kaki lengkap (mengangkat ke atas bergerak ke arah yang ditentukan dan menempatkannya kembali).
Tantangan berikutnya adalah melakukan studi gait, yaitu untuk mendefinisikan bagaimana robot harus berjalan dan berbelok dalam hal gerakan tubuh dan kaki. Robot saya selalu menggunakan gait yang stabil secara statis. Satu kaki diangkat satu per satu dan ditempatkan di posisi baru. Tubuh tinggal di tiga kaki lainnya dan untuk tidak terbalik titik gravitasi harus tetap dalam tripod yang dibentuk oleh kaki-kaki tersebut. Saya mengembangkan empat gait standar - maju, mundur, kiri dan kanan. Ini pada gilirannya menggunakan fungsi gerakan kaki dan tubuh untuk digabungkan menjadi urutan lengkap.
Saya juga merancang fungsi untuk gerakan servo sinkron. Dalam beberapa kasus beberapa servo membuat gerakan yang berbeda selama waktu tertentu. Ini harus disinkronkan untuk mencapai gerakan yang mulus.
Terakhir namun tidak kalah penting saya menggunakan baterai LiPo yang sepenuhnya tidak dilindungi. Ini dapat berisiko, bahaya utamanya adalah mengosongkannya terlalu cepat atau terlalu dalam. Bahaya pertama dihindari selama tidak secara tidak sengaja dihubungkan pendek. Baterai R/C normal memiliki laju pengosongan 25 C yang dalam hal ini memungkinkan 12 A. UBEC akan mencegahnya lebih dari 2 A dalam keadaan apa pun. Bahaya kedua dicegah oleh fungsi pemantauan dalam perangkat lunak. Tegangan diukur pada salah satu pin analog dan jika turun di bawah 7.0 V robot diistirahatkan.
Dan akhirnya saya harus menekankan bahwa baterai harus diisi dengan charger yang dibuat khusus dan ditangani dengan hati-hati, jangan pernah meninggalkan pengisian daya tanpa pengawasan. Baterai harus dilepas dari robot (gunakan velcro untuk memasangnya) dan diisi dalam kantong tahan api atau setidaknya dengan jarak aman dari bahan mudah terbakar sehingga kebakaran dapat terkandung dan tidak menyebar. Juga simpan baterai Anda dengan aman.
Jika Anda tidak familiar dengan baterai LiPo konsultasikan toko hobi R/C lokal dan beli baterai bersama dengan charger yang sesuai dan mungkin kantong/kontainer tahan api untuk pengisian dan penyimpanan. Item-item ini sering penuh tanda peringatan. Baca dan gunakan keputusan yang baik Anda sendiri. :)
Membangun robot
Cetak bagian sesuai dengan file yang disediakan. Luangkan waktu untuk melihat gambar dan mengerti cara merakit bagian sebelum memulai. Saya Skandinavia tetapi instruksi ini jauh dari tingkat instruksi IKEA atau LEGO :)
Sendi pinggul harus dirangkai terlebih dahulu. Saya menggunakan double sided tape berkualitas baik untuk menyambung bagian-bagian. Mereka dapat dilem juga tetapi jika ada kebutuhan untuk memperbaiki bagian yang rusak mereka tidak dapat dibongkar, satu servo yang rusak menyebabkan penggantian seluruh sendi.
Letakkan dukungan servo di bawah satu servo, sejajar dengan sumbu aktuasi. Kemudian gabungkan servo lain dengan sumbunya tegak lurus. Gambar di bawah ini menunjukkan sendi pinggul untuk depan-kanan dan belakang-kiri. Untuk dua sudut lainnya harus dibuat sendi yang tercermin.
Sebelum melanjutkan ide bagus untuk memastikan bahwa semua 12 servo terpusat. Cara terbaik adalah merakit PCB (atau breadboard, lihat di bawah), menghubungkan semua servo dan memuat kode. Ketika Arduino dihidupkan semua servo akan pusat (sinyal perintah 90 derajat). Akan perlu penyesuaian halus posisi pusat nanti setelah robot dirangkai.
Langkah selanjutnya adalah memasang bagian yang disebut paha, "lengan atas" dari rangkaian kaki. Bagian ini memiliki recess yang cocok dengan horn servo yang biasanya disertakan bersama servo. Lem horn ke dalam recess. Pastikan untuk menggunakan lem yang bekerja untuk menyambungkan bahan cetakan 3D dan plastik nylon yang terbuat dari horn. Pemolot lem yang saya gunakan berfungsi baik, saya telah memiliki kebercampuran sukses dengan lem CA (beberapa merek bekerja, yang lain tidak).
Paha disambungkan ke sendi pinggul dengan sudut 60 derajat. Coba temukan posisi yang mendekati sudut ini seakurat mungkin saat servo telah dipusat. Amankan horn pada spline servo dengan sekrup yang disediakan (sering kali yang lebih pendek dari tiga yang disertakan bersama servo). Di bawah ini dua gambar paha dan pinggul yang dirangkai, horn servo tidak disertakan untuk kejelasan (atau tidak pernah dimodelkan karena malas dari pihak saya).
Bagian bawah kaki juga harus dirangkai. Dalam kasus ini servo dipasang pada bagian kaki menggunakan sekrup. Ada sekrup yang disertakan bersama servo (sering kali dua sekrup "kayu" lebih panjang).
Sekarang kaki dapat dirangkai pada tubuh. Ada dua bagian yang saya sebut "bumper" yang berada di depan dan belakang robot (seperti bumper mobil). Mereka memiliki recess untuk horn servo seperti bagian paha. Lem horn ke dalamnya. Kemudian geser dukungan servo dari kaki atas ke lubang yang sesuai di tubuh. Setelah ini dilakukan di kedua sisi, rangkaian dapat diamankan oleh bumper. Biarkan kaki menunjuk ke luar sekitar 12 derajat (toe-out 20 mm kaki). Bumper diamankan ke tubuh dengan menggunakan sekrup servo yang tersisa (yang lebih panjang).
Terakhir kaki bawah robot dapat dipasang. Mereka harus diarahkan ke arah yang berlawanan dengan paha, membuat ujung kaki tepat di bawah sendi pinggul dari setiap rangkaian kaki.
Dengan ini robot dirangkai. Seharusnya terlihat seperti gambar di bawah ini. Catat bahwa desain robot telah berubah sedikit dibandingkan gambar atas dan klip film. Tubuh telah dirancang ulang untuk menyederhanakan dan membuat desain yang lebih kuat. Dukungan servo dan horn untuk sendi pinggul telah menukar tempat. Jadi rangkai sesuai dengan gambar 3D dan hindari kebingungan dengan foto dan klip film.
Tentu saja sudut setiap sendi tidak dapat sama persis dengan sudut yang diperlukan, jumlah spline pada servo SG-90 adalah 21, yang mengarah pada sudut 17 derajat antara dua posisi. Anda paling baik dapat merakit robot dalam 10-20 derajat, kesalahan yang tersisa harus disesuaikan dengan mengubah posisi netral dalam kode, lihat lebih lanjut di instruksi ini. Mungkin ide bagus untuk sekali lagi menghubungkan semua servo dan menghidupkan Arduino dan memeriksa posisi netral dan jika perlu melakukan penyesuaian mekanis (memindahkan sendi satu atau dua spline). Seseorang cenderung secara tidak sengaja memutar servo saat bekerja dengan mereka.
Menghubungkan Elektronika
Ada dua opsi, memiliki semuanya di satu breadboard atau untuk membuat PCB dengan file Fritzing yang disediakan. Anda mungkin akan mengalami beberapa masalah dengan tegangan di breadboard jika Anda tidak berhati-hati saat menghubungkan semua garis daya dan ground ke servo. Dalam kasus ekstrim satu servo dapat mengonsumsi 600 mA dan koneksi yang buruk menyebabkan perilaku yang tidak stabil. PCB memiliki jejak tembaga yang sangat lebar untuk garis daya jadi jika Anda solder dengan baik akan berfungsi dengan baik.
Tidak ada saklar daya dalam desain saya. Robot cukup dinyalakan dan dimatikan dengan menghubungkan baterai. Jika Anda ingin menambahkan satu itu harus setelah konektor baterai, memotong pasokan 7.4 V baik ke Arduino maupun ke UBEC.
Versi Breadboard
Mungkin untuk memiliki Pro Mini, konektor untuk servo dan sebagian besar elektronika lain di separuh breadboard. Saya menggambar skematik di gambar di bawah ini. Pastikan untuk menggunakan kabel jumper pendek, terutama untuk koneksi daya 5 V dan ground ke servo. Konektor servo hanyalah header pria tambahan panjang yang dipotong menjadi potongan tiga dan ditekan ke dalam breadboard.
Apa yang tidak ditampilkan dalam gambar adalah baterai dan UBEC. Mungkin ada beberapa solder untuk memperbaiki ini untuk memasang konektor yang cocok dengan baterai. Dari konektor dua kabel jumper harus dihubungkan ke "power rail" bawah breadboard untuk memberi daya pada Pro Mini (terhubung ke RAW dan GND). Juga hubungkan dua resistor dari pasokan 7.4 V ke pin A0. 2.2k pergi dari sisi positif dan 1k dari ground. Ini akan membagi tegangan, yang lebih dari 8 V pada baterai penuh, ke nilai di bawah 5 V yang dapat diukur oleh pin analog.
Sisi output UBEC memiliki konektor servo. Cukup nyaman untuk menambahkan dua header pria di "power rail" atas. Letakkan di tengah seperti dalam gambar untuk memastikan distribusi daya ke servo seimbang seakurat mungkin.
Penerima IR harus dihubungkan ke A1 dan memiliki pasokan 5V. Pin pada penerima cukup panjang untuk dipasang langsung ke lubang di breadboard.
Ada skematik di bawah dan gambar bagaimana breadboard yang selesai mungkin terlihat. Catat bahwa gambar menunjukkan versi lama robot dengan pinout dan koneksi yang berbeda. Ini masih memberikan gambaran tentang cara menghubungkan kabel jumper dan konektor servo.
Breadboard dilekatkan ke tubuh dengan sisi belakang self-adhesive. Oriensikan sehingga sudut dengan servo yang terhubung ke pin D3, D4 dan D5 (kanan atas dalam skematik) berada di sudut depan/kiri robot dan pastikan board berada di tengah tubuh (titik gravitasi yang benar sangat penting).
Versi PCB
Saya menambahkan file Fritzing di bawah. Ini dapat digunakan untuk membuat PCB, baik dengan memesan dari layanan yang tersedia di Fritzing atau dengan mengekspor file untuk pembuatan PCB. Saya membuat serangkaian gambar untuk menunjukkan rangkaian di bawah. PCB dibuat khusus untuk robot ini dengan konektor ke semua servo, IR dan pengukuran tegangan. Tapi ada juga konektor yang terpecah dari pin yang tersisa. Ini dapat digunakan untuk menghubungkan peralatan lain jika Anda ingin memperluas robot di masa depan.
Ada "pads" kecil di tubuh yang cocok dengan sudut PCB. Juga di sini sudut dengan konektor D3 hingga D5 harus di depan/kiri. Ada lubang pemasangan di PCB tapi saya hanya menggunakan sepotong double sided tape di tubuh untuk melekatkannya. Ini akan tetap di tempat.
Baterai
Baterai dilekatkan di bagian bawah dengan velcro. Ada permukaan rata yang khusus untuk ini di tubuh. Baterai LiPo 7.4V/500mAh biasanya memiliki ukuran sekitar 55x30x10 mm (beri atau kurangi beberapa mm) dan cukup cocok di tempat ini.
Terakhir robot dapat "ditambahkan sentuhan akhir" dengan merapikan kabel servo menjadi ikatan rapi sehingga tidak tergiur olehnya saat berjalan. Ini juga memberikan robot tampilan bagus sebenarnya merupakan seekor makhluk empat kaki yang berjalan di sekitar dan bukan tumpukan kabel servo. :)
Penyelempenan
Sebelum menggunakan robot posisi pusat harus disesuaikan halus. Ini dilakukan dengan mengedit array servodeg0 dalam kode:
Nilai-nilai tersebut dalam urutan alfa, beta gamma dan depan/kiri, belakang/kiri, depan/kanan, belakang/kanan. Jadi beta di depan kanan adalah posisi kedelapan dalam array atau servodeg0[7] (penomoran array dimulai dengan 0).
Ada juga array yang disebut servodir yang mendefinisikan arah rotasi servo.
const int servodir[12] = { +1, +1, -1, -1, -1, +1, -1, -1, -1, +1, +1, +1}; // Arah putaran (positif adalah servo berjalan searah jarum jam)
Servo yang saya gunakan bergerak dari 0 hingga 180 derajat dalam arah searah jarum jam. Saya telah membaca di suatu tempat bahwa ada servo yang bergerak di arah lain. Dalam hal tersebut array servodir harus mengubah tanda semuanya.
Nyalakan Arduino dan periksa sudut semua servo. Lakukan pengukuran dan lihat semuanya terlihat lurus dan simetris. Jarak dan sudut harus sesuai dengan gambar di bawah ini.
Sulit untuk dalam milimeter yang tepat pada setiap pengukuran, untuk dalam cm wajar. Lihat apa perubahan yang diperlukan dan tambahkan/kurangkan ke nilai dalam array servodeg0. Ini pasti akan memerlukan beberapa iterasi sebelum semuanya benar. Anda akan berakhir dengan array servodeg0 yang terlihat seperti ini (sebuah potongan kode sebenarnya dari salah satu robot saya). Dan yang paling penting, Anda harus pada akhirnya memiliki robot yang beristirahat di semua empat kaki dan berdiri lurus.
Servo mungkin perlu dikalibrasi lagi setelah beberapa waktu. Posisi pusat dapat menempel seiring waktu. Cukup periksa apakah semuanya teratur dari waktu ke waktu.
Jika Anda telah melakukan semuanya dengan benar dan masih memiliki robot yang akan terbalik, periksa titik gravitasi. Baterai dapat dipindahkan untuk menyeimbangkan ini, satu hal baik dengan menggunakan velcro.
Dan sekali lagi. Jaga baterai LiPo Anda dengan hati-hati.
Peningkatan Lebih Lanjut
Dengan mengajukan robot saya di sini saya juga mengundang orang untuk menyempurnakan desain, baik dengan menambahkan lebih banyak fungsi atau dengan melakukan tata letak yang sedikit berbeda (lebih besar, lebih kecil, tampilan lebih keren). Kode harus dapat digunakan kembali pada robot dengan tata letak atau ukuran yang sedikit berbeda. Skets di bawah ini menunjukkan konstanta apa dalam kode. Semua fungsi IK dan gerakan harus masih berfungsi jika robot dengan ukuran berbeda dibuat. Ini juga menunjukkan koordinat didefinisikan, x menunjuk ke arah maju.
Dan tentu saja akan menarik jika orang menambahkan fungsi ke robot. Ada beberapa tombol pada remote yang dapat diberi fungsi (mengapa tidak menari atau melakukan urutan gerakan lain jika tombol ditekan).
Saya pribadi bereksperimen dengan input analog. Saya juga telah bekerja dengan gait "berbelok sambil berjalan" untuk dapat mengarah robot dalam beberapa cara, atau untuk memperbaiki penyimpangan kursus dengan bantuan gyro atau kompas. Dan saya juga menambahkan sensor ultrasonik dan perilaku otonom (menghindari rintangan). Proyek saat ini saya adalah menggabungkan kontrol analog dengan otonom dan semuanya dikontrol dari smartphone. Ini telah memaksa saya untuk mempelajari banyak hal baru (Blynk, ESP6822, komunikasi serial antara perangkat dll) dan semoga saya dapat meluncurkan versi yang disempurnakan dari robot (atau mungkin seseorang dengan keterampilan lebih baik mengalahkan saya di hal itu) :)
Kode
Kode untuk KITtyBot2
Kode untuk KITtyBot2Arduino
Unggah ke Arduino Mini
/* Versi kontrol IR dari KITtyBot 2. Menggunakan Arduino Pro Mini dan papan PCB yang dirancang oleh saya (skets Fritzing Kittybotmini.fzz) Didasarkan pada robot sebelumnya KITtyBot dan KITtyBot mini menggunakan remote IR untuk mengontrol robot Menggunakan remote NEC (Adafruit) dan perpustakaan IRLib2, lihat https://github.com/cyborg5/IRLib2. Unduh perpustakaan IRLib2 dari repositori dan instal sesuai instruksi. Dimensi umum mirip dengan KITtyBot asli tetapi ada perpindahan antara sumbu gamma dan alfa sebesar 12 mm (servo dipasang satu di atas yang lain) Saya terus menyesuaikan gait untuk berjalan dan berbelok tetapi sejauh ini saya merasa ini telah memberikan perilaku paling stabil. Dibuat oleh Staffan Ek 2017 */ #include <IRLibRecv.h> #include <Servo.h> #include <IRLibDecodeBase.h> // Include decode base terlebih dahulu #include <IRLib_P01_NEC.h> // Hanya sertakan protokol yang Anda gunakan #define MY_PROTOCOL NEC // Mendefinisikan kontrol IR (NEC) long Previous; IRrecv My_Receiver(A1);//Terima di pin A0 IRdecodeNEC My_Decoder; const int servonum = 12; // Jumlah servo Servo servo[servonum]; // Buat objek servo const float servodeg0[12] = {90, 90, 90, 90, 90, 90, 90, 90, 90, 90, 90, 90}; // Posisi netral servo yang disesuaikan dari 90 derajat nominal (kalibrasi diperlukan untuk menyesuaikan nilai ini) float servodegnew[servonum]; // Posisi servo yang diinginkan dalam derajat float servodegold[servonum]; // Posisi servo lama (atau saat ini) // Perbarui nilai di bawah ke KITtyBot mini const int servodir[12] = { +1, +1, -1, -1, -1, +1, -1, -1, -1, +1, +1, +1}; // Arah putaran (positif adalah servo berjalan searah jarum jam) const float pi = 3.1416; const float alfa0 = pi / 6; // Posisi netral alfa (30 derajat) const float beta0 = pi / 3; // Posisi netral beta (60 derajat) const float jointlength = 50; // Panjang bagian kaki (keduanya memiliki panjang yang sama) const float width = 120; // Lebar (jarak antara kaki di arah y, dengan toeout0 ditambahkan) const float leng = 120; // Panjang (jarak antara kaki di arah x) const float distag = 12; // Jarak antara sumbu alfa dan gamma const float toeout0 = 20; // Jarak kaki keluar dari pusat servo gamma (jarak kaki menunjuk ke luar) const float leglength0 = 2 * jointlength * cos(alfa0); const float gamma0 = asin(toeout0 / (leglength0 + distag)); // Posisi netral gamma (karena toe out 20 mm dan distag 12 mm) const float bodyradius = sqrt(pow((width / 2), 2) + pow((leng / 2), 2)); // Panjang diagonal (jarak dari pusat ke sudut kaki) const float phi0 = atan(width / leng); // Sudut bodyradius vs sumbu x (menunjuk maju) const float height0 = sqrt(pow(leglength0 + distag, 2) - pow(toeout0, 2)); // Tinggi normal robot (jika sudut atau jarak diubah ini harus diperbarui) float leglength [4] = {sqrt(pow(height0, 2) + pow(toeout0, 2)), sqrt(pow(height0, 2) + pow(toeout0, 2)), sqrt(pow(height0, 2) + pow(toeout0, 2)), sqrt(pow(height0, 2) + pow(toeout0, 2)) }; // Nilai awal leglength unsigned long timestep = 500; // Waktu yang diambil oleh setiap urutan (saat menggunakan servomove()) int steplength = 40; //Panjang langkah di arah x selama berjalan (creep maju dan mundur) float phi = 20; // sudut belokan saat berbelok (dalam derajat, bukan radian!) // Variabel untuk gerakan float footpos[12]; // Posisi kaki, urutan LeftFrontxyz, LeftRearxyz, RightFrontxyz, RightRearxyz float stepturn[12] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; // Gerakan kaki dalam kasus belokan // Posisi kaki dikalibrasi dengan posisi awal mereka const float jointangle0[12] = {alfa0, beta0, 0, alfa0, beta0, 0, alfa0, beta0, 0, alfa0, beta0, 0}; float jointangle[12]; //Menggunakan vektor untuk sudut, urutan LeftFrontAlfaBetaGamma etc const int voltagepin = A0; // Pin yang ditetapkan untuk pengukuran tegangan int lowvolt = 0; // Variabel yang menghentikan robot jika tegangan turun <7.0 V int mode = 0; // Mode berjalan saat ini yang dipesan; maju, mundur, kiri, kanan void setup() { Serial.begin(9600); Serial.println("KITtyBot mini"); //Baris ini hanya untuk memeriksa konfigurasi. Dapat dihapus. Serial.print("Gamma0: "); Serial.println(gamma0); Serial.print("Leglength0: "); Serial.println(leglength0); Serial.print("Bodyradius: "); Serial.println(bodyradius); Serial.print("Phi0: "); Serial.println(phi0); Serial.print("Height0: "); Serial.println(height0); servo[0].attach(3); servo[1].attach(4); servo[2].attach(5); servo[3].attach(6); servo[4].attach(7); servo[5].attach(8); servo[6].attach(2); servo[7].attach(A3); servo[8].attach(12); servo[9].attach(11); servo[10].attach(10); servo[11].attach(9); for (int i = 0; i < servonum; i++) { // Pusatkan semua nilai dan keluaran ke servo servodegnew[i] = servodeg0[i]; servodegold[i] = servodegnew[i]; servo[i].write(servodegnew[i]); } delay(5000); My_Receiver.enableIRIn(); // Mulai penerima } void loop() { voltmeasure(); // Periksa tegangan setidaknya di sini while (lowvolt == 0) { // Lanjutkan hanya jika ada cukup daya bodyxyz(0, 0, 0); // Pastikan semuanya terpusat servomove(); mode = 0; IRread(); Serial.print("Mode: "); // Hanya untuk pemantauan di konsol serial, dapat dihapus Serial.println(mode); switch (mode) { case 1: forwardcreep(); break; case 2: reversecreep(); break; case 3: leftturn(); break; case 4: rightturn(); break; } voltmeasure(); delay(500); } if (lowvolt == 1) { // Pergi ke "istirahat". Sinyal jelas bahwa baterai perlu diisi daya bodyxyz (0, 0, -30); // Turunkan tubuh, sinyal jelas bahwa telah beristirahat servomove(); } } // Di bawah ini fungsi yang dipanggil dalam urutan yang benar untuk menghitung sudut baru void lengthangles() { // Kaki depan kiri jointangle[2] = gammaleft(footpos[1], footpos[2]); leglength[0] = legleft(footpos[0], footpos[2], jointangle[2]); jointangle[1] = beta(leglength[0]); jointangle[0] = alfafront(footpos[0], jointangle[1], leglength[0]); // Kaki belakang kiri jointangle[5] = gammaleft(footpos[4], footpos[5]); leglength[1] = legleft(footpos[3], footpos[5], jointangle[5]); jointangle[4] = beta(leglength[1]); jointangle[3] = alfarear(footpos[3], jointangle[4], leglength[1]); // Kaki depan kanan jointangle[8] = gammaright(footpos[7], footpos[8]); leglength[2] = legright(footpos[6], footpos[8], jointangle[8]); jointangle[7] = beta(leglength[2]); jointangle[6] = alfafront(footpos[6], jointangle[7], leglength[2]); // Kaki belakang kanan jointangle[11] = gammaright(footpos[10], footpos[11]); leglength[3] = legright(footpos[9], footpos[11], jointangle[11]); jointangle[10] = beta(leglength[3]); jointangle[9] = alfarear(footpos[9], jointangle[10], leglength[3]); } // Fungsi yang digunakan untuk menghitung IK // Gamma, servo pinggul "di atas" float gammaleft (float dy, float dz) { float gresult = atan((toeout0 + dy) / (height0 - dz)) - gamma0; return gresult; } float gammaright(float dy, float dz) { float gresult = gamma0 - atan((toeout0 - dy) / (height0 - dz)); return gresult; } // Menghitung panjang kaki (jarak sumbu alfa ke kaki) float legleft(float dx, float dz, float gamma) { float lresult = sqrt(pow(leglength0 - (dz / cos(gamma0 + gamma)), 2) + pow(dx, 2)); if (lresult > 2 * jointlength) lresult = 2 * jointlength; // Jika leglength lebih tinggi dari yang mungkin beberapa fungsi berikut menjadi tidak stabil return lresult; } float legright(float dx, float dz, float gamma) { float lresult = sqrt(pow(leglength0 - (dz / cos(gamma0 - gamma)), 2) + pow(dx, 2)); if (lresult > 2 * jointlength) lresult = 2 * jointlength; // Jika leglength lebih tinggi dari yang mungkin beberapa fungsi berikut menjadi tidak stabil return lresult; } // Beta, "sendi lutut" float beta(float leg) { float bresult = 2 * acos(leg / (2 * jointlength)); return bresult; } // Alfa, servo pinggul lainnya float alfafront(float dx, float beta, float leg) { float aresult = (beta / 2) - asin(dx / leg); return aresult; } float alfarear(float dx, float beta, float leg) { float aresult = (beta / 2) + asin(dx / leg); return aresult; } // Memberikan posisi kaki berdasarkan sudut belokan f (dalam derajat). Stepturn digunakan untuk membuat nilai footpos void turnpos(float f) { stepturn[0] = bodyradius * cos(phi0 + (f * pi / 180)) - leng / 2; stepturn[1] = bodyradius * sin(phi0 + (f * pi / 180)) - width / 2; stepturn[3] = bodyradius * cos(pi - phi0 + (f * pi / 180)) + leng / 2; stepturn[4] = bodyradius * sin(pi - phi0 + (f * pi / 180)) - width / 2; stepturn[6] = bodyradius * cos(2 * pi - phi0 + (f * pi / 180)) - leng / 2; stepturn[7] = bodyradius * sin(2 * pi - phi0 + (f * pi / 180)) + width / 2; stepturn[9] = bodyradius * cos(pi + phi0 + (f * pi / 180)) + leng / 2; stepturn[10] = bodyradius * sin(pi + phi0 + (f * pi / 180)) + width / 2; } // Menghitung posisi servo (dalam derajat) berdasarkan sudut sendi dalam fungsi di atas void servopos() { for (int i = 0; i < 12; i++) { servodegnew[i] = servodeg0[i] + servodir[i] * (jointangle[i] - jointangle0[i]) * 180 / pi; } } // Algoritma servo untuk gerakan terkontrol dan sinkron. Semua servo harus mencapai posisi akhir mereka di akhir timestep void servomove() { int servotimeold[servonum]; // Variabel lokal untuk waktu posisi servo terakhir int servotimenew[servonum]; // Variabel lokal untuk waktu saat servo diposisikan int SERVOPULSE[servonum]; // Variabel lokal untuk ditulis ke driver servo float servodeg[servonum]; // Variabel lokal untuk posisi servo saat ini float servodegspeed[servonum]; // Variabel lokal untuk kecepatan servo yang diinginkan derajat per milidetik unsigned long starttime = millis(); // Stempel waktu awal algoritma unsigned long timenow = starttime; // Mengatur ulang waktu sekarang for (int i = 0; i < servonum; i++) { servodegspeed[i] = (servodegnew[i] - servodegold[i]) / timestep; // Menghitung kecepatan servo yang diinginkan servodeg[i] = servodegold[i]; // Mengatur ulang posisi servo servotimeold[i] = starttime; // Mengatur ulang waktu } while ((timenow - starttime) < timestep) { // Loop berlanjut hingga timestep terpenuhi for (int i = 0; i < servonum; i++) { // Iterasi melalui setiap servo servotimenew[i] = millis(); // Dapatkan stempel waktu servodeg[i] += servodegspeed[i] * (servotimenew[i] - servotimeold[i]); // Menghitung posisi baru berdasarkan kecepatan yang diinginkan dan waktu berlalu servo[i].write(servodeg[i]); // Posisikan servo servotimeold[i] = servotimenew[i]; // Mengatur ulang waktu servo lama untuk iterasi berikutnya } timenow = millis(); // Dapatkan stempel waktu setelah semua servo telah diiterasi untuk digunakan dalam while case. } for (int i = 0; i < servonum; i++) { // Lakukan iterasi terakhir untuk memastikan servo telah mencapai posisi akhir servo[i].write(servodegnew[i]); // Posisikan servo servodegold[i] = servodegnew[i]; // Mengatur ulang posisi saat ini untuk iterasi mendatang } } // Servomove tanpa timing, gunakan saat tidak perlu gerakan sinkron, yaitu mengangkat/gerakkan satu kaki void servomovefast() { for (int i = 0; i < servonum; i++) { // Lakukan iterasi terakhir untuk memastikan servo telah mencapai posisi akhir servo[i].write(servodegnew[i]); // Posisikan servo servodegold[i] = servodegnew[i]; // Mengatur ulang posisi saat ini untuk iterasi mendatang } delay(100); // Beri waktu yang wajar untuk servo mencapai titik akhir sebelum melanjutkan. } // Menghitung posisi kaki (koordinat xyz) void footxyz(int i, float x, float y, float z) { footpos[3 * i] = x; footpos[3 * i + 1] = y; footpos[3 * i + 2] = z; lengthangles(); servopos(); } // Menghitung gerakan kaki, menambahkan nilai yang diinginkan ke posisi saat ini void footmovexyz(int i, float x, float y, float z) { footpos[3 * i] += x; footpos[3 * i + 1] += y; footpos[3 * i + 2] += z; lengthangles(); servopos(); } // Menghitung posisi tubuh sesuai koordinat xyz. void bodyxyz(float x, float y, float z ) { //Catat: Menggerakkan tubuh berarti menggerakkan kaki ke arah yang berlawanan, oleh karena itu tanda minus di semua posisi kaki for (int i = 0; i < 4; i++) { footpos[3 * i] = -x; footpos[3 * i + 1] = -y; footpos[3 * i + 2] = -z; } lengthangles(); servopos(); } // Menghitung gerakan tubuh, menambahkan koordinat ke posisi yang ada. void bodymovexyz(float x, float y, float z ) { //Catat: Gerakan tubuh berarti menggerakkan kaki ke arah yang berlawanan, oleh karena itu tanda minus di semua posisi kaki for (int i = 0; i < 4; i++) { footpos[3 * i] -= x; footpos[3 * i + 1] -= y; footpos[3 * i + 2] -= z; } lengthangles(); servopos(); } // Menghitung putaran tubuh dengan sudut yang diinginkan phi void bodytwist(float f) { // Di sini lagi gerakan adalah di arah minus dari posisi kaki turnpos(-f); for (int i = 0; i < 12; i++) { footpos[i] += stepturn[i]; } lengthangles(); servopos(); } // Melakukan gerakan kaki; mengangkat gerak xy dan menempatkan kaki void footstep (int i, float x, float y) { footmovexyz(i, 0, 0, 30); servomovefast(); footmovexyz(i, x, y, 0); servomovefast(); footmovexyz(i, 0, 0, -30); servomovefast(); } // Melakukan gerakan kaki berdasarkan sudut belokan yang diinginkan, menggerakkan kaki sepanjang lingkaran belokan void (footstepangle(int i, float f)) { turnpos(f); footmovexyz(i, 0, 0, 30); servomovefast(); footmovexyz(i, stepturn[3 * i], stepturn [3 * i + 1], 0); servomovefast(); footmovexyz(i, 0, 0, -30); servomovefast(); } // Memeriksa tegangan, dalam kasus baterai rendah variabel lowvolt berubah void voltmeasure() { /* Catat: Baterai 7.6 V dihubungkan melalui resistor 2.2k dari BAT ke voltagepin dan 1.0k ke GND Ini memberikan input analog 5 V rentang pengukuran 16 volt*/ float voltsig = analogRead(voltagepin); float voltage = voltsig * 16 / 1023.0; Serial.print("Battery: "); Serial.println(voltage); if (voltage < 7.0) { lowvolt = 1; } else { lowvolt = 0; } } // Fungsi baca IR, berdasarkan skets contoh Adafruit void IRread() { if (My_Receiver.getResults()) { Serial.print("Recieving "); Serial.println (My_Decoder.value); if (My_Decoder.decode()) { if (My_Decoder.value == 0xFFFFFFFF) { // Mendeteksi apakah tombol masih ditekan dan mempertahankan nilai My_Decoder.value = Previous; } switch (My_Decoder.value) { // Mendeteksi apakah tombol panah ditekan dan mengatur parameter mode case 0xfda05f: mode = 1; break; case 0xfdb04f: mode = 2; break; case 0xfd10ef: mode = 3; break; case 0xfd50af: mode = 4; break; } Previous = My_Decoder.value; } My_Receiver.enableIRIn(); } else { mode = 0; } } // Gait untuk gerakan creep maju void forwardcreep() { bodymovexyz(steplength / 4, -toeout0, 0); // Memulai posisi untuk berjalan maju, miring ke kanan servomove(); footstep(1, steplength / 2, 0); // Menggerakkan kaki belakang setengah langkah footstep(0, steplength / 2, 0); // Dan kaki depan kiri bodymovexyz(steplength / 4, 2 * toeout0, 0); // Menggeser tubuh maju dan ke kiri (untuk menggerakkan kaki kanan nanti) servomove(); while (mode == 1) { // Di sini loop while dimulai, diulang selama maju dipesan (mode 1) footstep(3, steplength, 0); // Menggerakkan kaki belakang kanan ke depan footstep(2, steplength, 0); // Menggerakkan kaki depan kanan ke depan bodymovexyz(steplength / 2, -2 * toeout0, 0); // Menggeser tubuh maju dan ke kanan servomove(); footstep(1, steplength, 0); // Menggerakkan kaki belakang kiri ke depan footstep(0, steplength, 0); // Menggerakkan kaki depan kiri ke depan bodymovexyz(steplength / 2, 2 * toeout0, 0); // Menggeser tubuh maju dan ke kiri servomove(); // Robot memiliki posisi yang sama sebelum loop while tetapi telah maju steplength. IRread(); // Jika masih ada perintah maju (mode ==1) urutan harus diulang } // Loop while berakhir dan mengasumsikan posisi normal /* bodymovexyz(0, 10, 0);*/ footstep(3, steplength / 2, 0); // Mengambil setengah langkah untuk membuat semua kaki netral footstep(2, steplength / 2, 0); bodyxyz(0, 0, 0); // Memusatkan tubuh servomove(); // Meninggalkan mode gait } // Gait serupa untuk berjalan mundur (tidak dikomentari sebanyak, lihat forwardcreep void reversecreep() { bodymovexyz(-steplength / 4, -toeout0, 0); // Memulai posisi untuk berjalan maju servomove(); footstep(0, -steplength / 2, 0); footstep(1, -steplength / 2, 0); bodymovexyz(-steplength / 4, 2 * toeout0, 0); servomove(); while (mode == 2) { // Di sini loop while dimulai, diulang selama mundur dipesan (mode 2) footstep(2, -steplength, 0); footstep(3, -steplength, 0); bodymovexyz(-steplength / 2, -2 * toeout0, 0); servomove(); footstep(0, -steplength, 0); footstep(1, -steplength, 0); bodymovexyz(-steplength / 2, 2 * toeout0, 0); servomove(); IRread(); // Jika mode == 2 loop while dilanjutkan } // Loop while berakhir dan mengasumsikan posisi normal /* bodymovexyz(0, 10, 0);*/ footstep(2, -steplength / 2, 0); footstep(3, -steplength / 2, 0); bodyxyz(0, 0, 0); servomove(); // Meninggalkan mode gait } // Melakukan belokan ke kiri sudut phi yang diinginkan void leftturn() { while (mode == 3) { // Loop while selama tombol kiri ditekan bodyxyz(toeout0 / 2, toeout0, 0); // Miring ke kiri sebelum melakukan apa pun servomove(); footstepangle(3, phi); // Pindahkan kaki belakang kanan ke posisi baru footstepangle(2, phi); // Pindahkan kaki depan kanan ke posisi baru footxyz(0, -toeout0 / 2 - stepturn[0], toeout0 - stepturn[1], 0); footxyz(1, -toeout0 / 2 - stepturn[3], toeout0 - stepturn[4], 0); footxyz(2, -toeout0 / 2, toeout0, 0); footxyz(3, -toeout0 / 2, toeout0, 0); // Memutar tubuh dan miring ke kiri. Ditulis dalam koordinat absolut untuk meminimalkan kesalahan. servomove(); // Lakukan perintah servo sebenarnya footstepangle(0, phi); // Pindahkan kaki depan kiri footstepangle(1, phi); // Pindahkan kaki belakang kiri IRread(); // Periksa apakah tombol kiri masih ditekan (mode == 3), ulangi loop while } bodyxyz(0, 0, 0); // Pusatkan tubuh saat belokan selesai servomove(); } // Melakukan belokan ke kanan. Harus identik dengan belokan kiri tetapi dengan perintah yang berbeda. Sedang menguji keduanya saat ini. void rightturn() { while (mode == 4) { // Loop while selama tombol kanan ditekan bodyxyz(-toeout0 / 2, toeout0, 0); // Miring ke kiri sebelum melakukan apa pun servomove(); footstepangle(2, -phi); // Pindahkan kaki depan kanan footstepangle(3, -phi); // Pindahkan kaki belakang kanan footxyz(0, toeout0 / 2 - stepturn[0], toeout0 - stepturn[1], 0); footxyz(1, toeout0 / 2 - stepturn[3], toeout0 - stepturn[4], 0); footxyz(2, toeout0 / 2, toeout0, 0); footxyz(3, toeout0 / 2, toeout0, 0); // Memutar tubuh dan miring ke kiri. Ditulis dalam koordinat absolut untuk meminimalkan kesalahan. servomove(); // Lakukan perintah servo sebenarnya footstepangle(1, -phi); // Pindahkan kaki belakang kiri footstepangle(0, -phi); // Pindahkan kaki depan kiri IRread(); // Periksa apakah tombol kanan masih ditekan (mode == 4), ulangi loop while } bodyxyz(0, 0, 0); servomove(); }
Bagian dan Enclosure Kustom
Tubuh robot. Memuat PCB dan baterai. Di setiap ujung tubuh, seperti bumper mobil. Anda harus memiliki dua bagian ini. Mendukung sendi pinggul. Cetak empat bagian ini. Lengan atas kaki. Cetak empat bagian ini. Lengan bawah (atau kaki). Cetak empat bagian ini. Semua bagian dipasang bersama. Tidak untuk dicetak.
Skematik
Ini adalah file Fritzing untuk memungkinkan produksi PCB. Gunakan untuk memesan dari Fritzing sendiri atau ekspor ke format yang sesuai dan manufaktur di tempat lain.kittybotmini_XKZYltyQVJ.fzz