Программирование автономного полёта клевер3

Регистрация
06.08.2018
Сообщения
4
Симпатии
2
Баллы
3
#1
Недописанных код для автономного полёта Дрона с raspberry pi
import datetime
import math
from neopixel import *
import rospy
import time
from clever import srv
from std_srvs.srv import Trigger
from mavros_msgs.srv import SetMode

rospy.init_node('foo')

LED_COUNT = 30
LED_PIN = 21
LED_FREQ_HZ = 800000
LED_DMA = 10
LED_BRIGHTNESS = 255
LED_INVERT = False


navigate = rospy.ServiceProxy('/navigate', srv.Navigate)
get_telemetry = rospy.ServiceProxy('/get_telemetry', srv.GetTelemetry)

strip = Adafruit_NeoPixel(LED_COUNT, LED_PIN, LED_FREQ_HZ, LED_DMA, LED_INVERT, LED_BRIGHTNESS)
strip.begin()
for i in range(0, strip.numPixels(), 1):
strip.setPixelColor(i, Color(100, clr+15, 0))
time.sleep(0.1)
clr=clr+10
strip.show()
navigate(x=0.0,y=0.0, z=1, speed=0.5, yaw = float('nan'), frame_id='fcu_horiz', update_frame=False, auto_arm=True)
time.sleep(2)
navigate(x=0.3, y=0.5, z=1, speed=0.4, yaw = float('nan'), frame_id='aruco_map', update_frame=True, auto_arm=False)