Агуулгын хүснэгт:

FK (Forward Kinematic) Excel, Arduino & Processing -тэй: 8 алхам
FK (Forward Kinematic) Excel, Arduino & Processing -тэй: 8 алхам

Видео: FK (Forward Kinematic) Excel, Arduino & Processing -тэй: 8 алхам

Видео: FK (Forward Kinematic) Excel, Arduino & Processing -тэй: 8 алхам
Видео: 5 DOF robot - Forward and Inverse Kinematics - Python (RPI) + Arduino 2024, Арваннэгдүгээр
Anonim
FK (Forward Kinematic) Excel, Arduino & Processing програмтай
FK (Forward Kinematic) Excel, Arduino & Processing програмтай

Forward Kinematic нь 3D орон зайд End Effector утгуудыг (x, y, z) олоход хэрэглэгддэг.

Алхам 1: Үндсэн онол

Үндсэн онол
Үндсэн онол

Зарчмын хувьд урагш кинематик нь хосолсон (хамтарсан) тригонометрийн онолыг ашигладаг. Урт (r) ба өнцөг (0) параметрүүдийн тусламжтайгаар төгсгөлийн эффекторын байрлалыг 2D зайны хувьд (x, y), 3D -ийн хувьд (x, y, z) мэдэж болно.

Алхам 2: загвар

Загвар
Загвар

Энэ загварыг teta1 (0 градус), teta1 (0 градус), teta2 (0 градус), teta3 (0 градус), teta4 (0 градус) гэж үздэг. Мөн a1-a4 = 100 мм урт (хүссэнээр өөрчлөх боломжтой). Өнцөг ба уртыг Excel -д дуурайж болно (татаж авах файл).

Алхам 3: Эффекторын төгсгөл

Эцсийн эффектор
Эцсийн эффектор

Дээрх матрицаас томъёог Excel ашиглан загварчилсан болно.

Алхам 4: Excel -ийн симуляци

Excel -ийн симуляци
Excel -ийн симуляци
Excel -ийн симуляци
Excel -ийн симуляци

Excel1 дээр лавлах үндсэн онол байдаг. Өнцөг ба уртын хувьд

шаардлагатай бол өөрчлөх. Үүнийг хожим нь End Effector (xyz) гэж нэрлэх болно. Учир нь Excel бол миний бүтээсэн систем юм.

Алхам 5: Arduino диаграм ба систем

Arduino диаграм ба систем
Arduino диаграм ба систем
Arduino диаграм ба систем
Arduino диаграм ба систем
Arduino диаграм ба систем
Arduino диаграм ба систем

Хангамж: 1. Arduino Uno 1 ширхэг

2. Потенциометр 100к Ом 5 ширхэг

3. Кабель (шаардлагатай)

4. PC (Arduino IDE, Excel, Боловсруулах)

5. USB кабель

6. Cardbard (шаардлагатай) Би статик цахилгаан гүйдэлд орохгүйн тулд Arduino Uno -ийг хуучин PLC хайрцагт хийсэн. Цахилгааны холболтын схемийг зурагнаас үзнэ үү. Forward Arm кинематик сал тоног төхөөрөмжийн системийн хувьд хийгдсэн системийн дагуу.

Алхам 6: Arduino програмыг байршуулах

Arduino програмыг байршуулах
Arduino програмыг байршуулах

Arduino програмын файлууд татаж авах файлд байна.

Алхам 7: Симуляцийг боловсруулах

Симуляцийг боловсруулж байна
Симуляцийг боловсруулж байна

Файл татаж авсан програм.

Алхам 8: Эцсийн шат

Image
Image

Лавлагаа: 1.

2. Онол (файл татаж авах үед)

3.

Зөвлөмж болгож буй: