diff --git a/model/tello/.idea/.gitignore b/model/tello/.idea/.gitignore deleted file mode 100644 index 26d33521..00000000 --- a/model/tello/.idea/.gitignore +++ /dev/null @@ -1,3 +0,0 @@ -# Default ignored files -/shelf/ -/workspace.xml diff --git a/model/tello/.idea/inspectionProfiles/profiles_settings.xml b/model/tello/.idea/inspectionProfiles/profiles_settings.xml deleted file mode 100644 index 105ce2da..00000000 --- a/model/tello/.idea/inspectionProfiles/profiles_settings.xml +++ /dev/null @@ -1,6 +0,0 @@ - - - - \ No newline at end of file diff --git a/model/tello/.idea/misc.xml b/model/tello/.idea/misc.xml deleted file mode 100644 index c2bd5fcf..00000000 --- a/model/tello/.idea/misc.xml +++ /dev/null @@ -1,4 +0,0 @@ - - - - \ No newline at end of file diff --git a/model/tello/.idea/modules.xml b/model/tello/.idea/modules.xml deleted file mode 100644 index 6764e012..00000000 --- a/model/tello/.idea/modules.xml +++ /dev/null @@ -1,8 +0,0 @@ - - - - - - - - \ No newline at end of file diff --git a/model/tello/.idea/tello.iml b/model/tello/.idea/tello.iml deleted file mode 100644 index 74d515a0..00000000 --- a/model/tello/.idea/tello.iml +++ /dev/null @@ -1,10 +0,0 @@ - - - - - - - - - - \ No newline at end of file diff --git a/model/tello/KeyPressModule.py b/model/tello/KeyPressModule.py deleted file mode 100644 index 074cede0..00000000 --- a/model/tello/KeyPressModule.py +++ /dev/null @@ -1,18 +0,0 @@ -import pygame - -def init(): - pygame.init() - win = pygame.display.set_mode((400, 400)) - -def getKey(keyName): - ans = False - for eve in pygame.event.get(): pass - keyInput = pygame.key.get_pressed() - myKey = getattr(pygame,'K_{}'.format(keyName)) - if keyInput[myKey]: - ans = True - pygame.display.update() - return ans - -if __name__ == '__main__': - init() diff --git a/model/tello/__pycache__/KeyPressModule.cpython-310.pyc b/model/tello/__pycache__/KeyPressModule.cpython-310.pyc deleted file mode 100644 index 78137acd..00000000 Binary files a/model/tello/__pycache__/KeyPressModule.cpython-310.pyc and /dev/null differ diff --git a/model/tello/main.py b/model/tello/main.py deleted file mode 100644 index 782db7f7..00000000 --- a/model/tello/main.py +++ /dev/null @@ -1,81 +0,0 @@ -import logging -import time -import cv2 -from djitellopy import tello -import KeyPressModule as kp # 用于获取键盘按键 -from time import sleep - -def getKeyboardInput(drone, speed, image): - lr, fb, ud, yv = 0, 0, 0, 0 - key_pressed = 0 - if kp.getKey("e"): - cv2.imwrite('D:/snap-{}.jpg'.format(time.strftime("%H%M%S", time.localtime())), image) - if kp.getKey("UP"): - Drone.takeoff() - elif kp.getKey("DOWN"): - Drone.land() - - if kp.getKey("j"): - key_pressed = 1 - lr = -speed - elif kp.getKey("l"): - key_pressed = 1 - lr = speed - - if kp.getKey("i"): - key_pressed = 1 - fb = speed - elif kp.getKey("k"): - key_pressed = 1 - fb = -speed - - if kp.getKey("w"): - key_pressed = 1 - ud = speed - elif kp.getKey("s"): - key_pressed = 1 - ud = -speed - - if kp.getKey("a"): - key_pressed = 1 - yv = -speed - elif kp.getKey("d"): - key_pressed = 1 - yv = speed - InfoText = "battery : {0}% height: {1}cm time: {2}".format(drone.get_battery(), drone.get_height(), time.strftime("%H:%M:%S",time.localtime())) - cv2.putText(image, InfoText, (10, 20), font, fontScale, (0, 0, 255), lineThickness) - if key_pressed == 1: - InfoText = "Command : lr:{0}% fb:{1} ud:{2} yv:{3}".format(lr, fb, ud, yv) - cv2.putText(image, InfoText, (10, 40), font, fontScale, (0, 0, 255), lineThickness) - - drone.send_rc_control(lr, fb, ud, yv) - -# 主程序 -# 摄像头设置 -Camera_Width = 720 -Camera_Height = 480 -DetectRange = [6000, 11000] -PID_Parameter = [0.5, 0.0004, 0.4] -pErrorRotate, pErrorUp = 0, 0 - -# 字体设置 -font = cv2.FONT_HERSHEY_SIMPLEX -fontScale = 0.5 -fontColor = (255, 0, 0) -lineThickness = 1 - -# Tello初始化设置 -Drone = tello.Tello() # 创建飞行器对象 -Drone.connect() # 连接到飞行器 -Drone.streamon() # 开启视频传输 -Drone.LOGGER.setLevel(logging.ERROR) # 只显示错误信息 -sleep(5) # 等待视频初始化 -kp.init() # 初始化按键处理模块 - - -while True: - OriginalImage = Drone.get_frame_read().frame - Image = cv2.resize(OriginalImage, (Camera_Width, Camera_Height)) - getKeyboardInput(drone=Drone, speed=70, image=Image) # 按键控制 - cv2.imshow("Drone Control Centre", Image) - cv2.waitKey(1) \ No newline at end of file