Pengukuran sudut
Jika Anda ingin mengukur sudut (itulah yang saya baca dalam pertanyaan Anda), saya akan menggunakan potensiometer putar. Mereka super murah, ringan, dan mudah dibaca dengan mikrokontroler sederhana.
Kontrol
Kontrol servos harus bekerja dengan loop PID yang Anda beri makan setpoint Anda (sudut yang diinginkan) dan sudut yang diukur. Dengan mengadaptasi ketiga konstanta P, I, dan D Anda dapat mendefinisikan "perilaku gerakan Anda". Untuk mengendalikan motor, saya akan merekomendasikan Anda untuk menggunakan mikrokontroler daripada komputer. Biarkan komputer menghitung sudut untuk lengan robot, meneruskannya ke mikrokontroler Anda, dan yang terakhir harus berhati-hati mengukur sudut dan memindahkan servos Anda.
Perhitungan sudut
Jika pertanyaan Anda adalah bagaimana Anda menghitung sudut lengan robot sebagai fungsi posisi end-effector, kita perlu tahu berapa banyak sumbu yang Anda gunakan, yang panjangnya memiliki anggota badan robot dll. Namun, saya akan melihat pada mengoordinasikan transformasi. Ceritakan lebih lanjut tentang geometri robot dan saya akan mencoba membantu Anda :).