📊 Телеметрия get_orientation.py

Ориентация: roll, pitch, yaw

get_telemetry/get_orientation.py

Печатает углы крена, тангажа и рыскания.

Вызывает get_orientation() и выводит три угла в градусах.

Как работает

  1. Создать Pioneer().
  2. В цикле получить get_orientation().
  3. Вывести roll, pitch, yaw.
  4. Пауза 1 секунда, закрыть соединение.

Используемые методы SDK

Ключевые параметры

ПараметрЗначениеОписание
sleep1 сПериод опроса.

Запуск

cd get_telemetry
python3 get_orientation.py

Результат

  • roll=…, pitch=…, yaw=….

Полный исходный код

Показать get_orientation.py
from pioneer_sdk2 import Pioneer        # импортируем класс Pioneer из библиотеки pioneer_sdk2
import time                             # библиотека time содержит функции для работы со временем

drone = Pioneer()                       # создаем экземпляр класса Pioneer, устанавливаем соединение

try:                                    # основной код находится внутри блока try
    while True:                         # запускаем бесконечный цикл
        orientation = drone.get_orientation() # получаем ориентацию дрона

        # выводим roll, pitch, yaw в консоль
        print(f'roll={orientation[0]}, pitch={orientation[1]}, yaw={orientation[2]}')
        # print(f'yaw={orientation[2]}') # пример вывода yaw отдельно

        time.sleep(1)                   # ставим паузу на 1 секунду

finally:                                # блок finally выполнится при завершении программы
    drone.close_connection()            # закрываем соединение