RemoteXY - Arduino
Last updated
Last updated
ในตัวอย่างโปรแกรม Drone ในฝั่งของ Arduino IDE จะคล้ายกับ KBIDE เนื่องจากใช้ SDK ตัวเดียวกันจึงทำให้สามารถรันข้าม Platform กันได้เริ่มต้น Download Code จากลิงค์ด้านล่างกันก่อนเลย
สามารถกดปุ่มสีเขียว Download "Code" หลังจากนั้นแตกไฟล์ให้เรียบร้อยก็จะได้ SDK Drone Kit ที่พร้อมพัฒนากันแล้ว
ไฟล์ SDK Drone Kit จะมี Library ที่จำเป็นและถูกดัดแปลงมาให้สามารถใช้งานกับชุดคิทได้ จึงต้องใช้ Library ที่เราพัฒนาขึ้นมาเพื่อให้เจ้า Drone Kit มีความสามารถการบินที่ดีที่สุดบนบอร์ด KB32-FT
เปิดไฟล์ kb32ftdrone.ino
เมื่อดับเบิ้ลคลิ๊กเปิดไฟล์เสร็จจะมี Popup เด้งให้สร้าง folder ขึ้นมาใหม่ ให้กด "Cancel" หรือ กด "OK" เพื่อสร้าง folder ใหม่แต่ต้องย้ายไฟล์ Library ตามเข้าไปใน folder ด้วย
กด Cancel เพื่อไม่ต้องสร้าง folder ขึ้นมาให้ใช้ folder ให้ Libbrary อยู่ใน folder เดียวกัน
กด OK เพิ่มสร้าง folder ขึ้นมาแต่จำเป็นต้องย้าย Libbrary ไปอยู่ใน folder เดียวกัน
เลือกบอร์ด ESP32 Dev Module และทดลองกด Compile ดูว่าโปรแกรมรันผ่านหรือไม่
ใน ESP32 Version ถัดไปจะสามารถเลือกบอร์ด KB32-FT บน โปรแกรม Arduino IDE ได้แล้ว
ในขั้นตอนแรกตัวอย่างโปรแกรม DroneCal เป็นการเรียกอ่านค่าเริ่มต้นของเซนเซอร์ Accelerometer และ Gyroscope ของชิพ MPU-6050 ซึ่งใช้เป็นค่า offset ของโดรน
สังเกตุในบรรทัดที่ 291 - 300 จะเป็นการเปิดและปิดโหมดคาริเบทพร้อมใส่ค่าตัวแปรที่คาริเบทได้
ตัวอย่าง Code เริ่มต้นจะเป็นตัวอย่าง Calibration อยู่แล้วสามารถ Uplode โปรแกรมได้เลย เมื่อUpload เสร็จแล้วทดลองเปิด Serial port
Serial Monitor เลือก COMPORT ..... ตาม Port KB32-FT Serial Uplaod Baudrate : 115200
กด >>>> Connect >>>> หากไม่มีข้อความแสดงให้ กดปุ่ม Reset บนบอร์ด KB32-FT
เมื่อเปิดเมนู Serial Monitor แล้วตัวโปรแกรมจะแสดงค่า Accl , Gyro ของทั้ง 3 แกน จะมีทั้งหมด 6 ตัวแปร
ตัวอย่างค่าที่แสดงผล (เครื่องหมายลบ - ต้องพิมพ์ด้วย) ซึ่งโดรนแต่ละลำจะมีค่าที่อ่านได้ไม่เหมือนกัน
ปิดหรือคอมเมนต์บรรทัดที่ 298-300 ออกเพื่อไม่ให้โปรแกรมทำงานในโหมดคาริเบท แก้ไขค่าตัวแปรที่ได้จากการคาริเบทจำนวน 6 ตัวแปร จากนั้นกด Upload โปรแกรม
ตัวอย่างการแก้ไขค่าคาริเบท
เมื่อกด Upload แล้วสามารถใช้ App RemoteXY มาต่อและใช้งานได้เลย
X Accel
Y Accel
Z Accel
X Gyro
Y Gyro
Z Gyro
-4770
-1243
1068
-32
-123
-2