S64 / tellorche

Orchestration toolchain for TELLO drone
Other
2 stars 0 forks source link

3台で三角飛行 #66

Closed S64 closed 6 years ago

S64 commented 6 years ago

背景

複数台で隊列を組んだ飛行サンプルが無い

変更内容

3台での飛行サンプルを作成

S64 commented 6 years ago
Connected to the target VM, address: '127.0.0.1:50311', transport: 'socket'
[top] dbg: Received line: `!reset`.
[top] msg: Wi-Fi already disconnected.
[top] cmd: Wi-Fi disconnected.
[top] msg: Tellorche ESP32 Controller.
[top] cmd: wakeup.
[top] dbg: wait command...
[top] dbg: Received line: `cmd-controller: wifi_ssid TELLO-CFA138`.
[top] msg: Wi-Fi SSID: `TELLO-CFA138`.
[top] dbg: wait command...
[top] dbg: Received line: `cmd-controller: wifi_passphrase [secret]`.
[top] msg: Wi-Fi Passphrase: [secret]
[top] dbg: wait command...
[top] dbg: Received line: `cmd-controller: connect`.
[top] msg: Connect to Wi-Fi...
[top] I (546979) phy: phy_version: 383.0, 79a622c, Jan 30 2018, 15:38:06, 0, 0
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] no AP found
[top] dbg: .
[top] dbg: .
[top] msg: Wi-Fi connected.
[top] cmd: Wi-Fi connected.
[top] dbg: wait command...
[right] dbg: Received line: `!reset`.
[right] msg: Wi-Fi already disconnected.
[right] cmd: Wi-Fi disconnected.
[right] msg: Tellorche ESP32 Controller.
[right] cmd: wakeup.
[right] dbg: wait command...
[right] dbg: Received line: `cmd-controller: wifi_ssid TELLO-C410FB`.
[right] msg: Wi-Fi SSID: `TELLO-C410FB`.
[right] dbg: wait command...
[right] dbg: Received line: `cmd-controller: wifi_passphrase [secret]`.
[right] msg: Wi-Fi Passphrase: [secret]
[right] dbg: wait command...
[right] dbg: Received line: `cmd-controller: connect`.
[right] msg: Connect to Wi-Fi...
[right] dbg: .
[right] dbg: .
[right] no AP found
[right] dbg: .
[right] dbg: .
[right] no AP found
[right] dbg: .
[right] dbg: .
[right] dbg: .
[right] no AP found
[right] dbg: .
[right] dbg: .
[right] no AP found
[right] dbg: .
[right] dbg: .
[right] dbg: .
[right] no AP found
[right] dbg: .
[right] dbg: .
[right] no AP found
[right] dbg: .
[right] dbg: .
[right] no AP found
[right] dbg: .
[right] dbg: .
[right] dbg: .
[right] no AP found
[right] dbg: .
[right] dbg: .
[right] msg: Wi-Fi connected.
[right] cmd: Wi-Fi connected.
[right] dbg: wait command...
[left] dbg: Received line: `!reset`.
[left] msg: Wi-Fi already disconnected.
[left] cmd: Wi-Fi disconnected.
[left] msg: Tellorche ESP32 Controller.
[left] cmd: wakeup.
[left] dbg: wait command...
[left] dbg: Received line: `cmd-controller: wifi_ssid TELLO-C41057`.
[left] msg: Wi-Fi SSID: `TELLO-C41057`.
[left] dbg: wait command...
[left] dbg: Received line: `cmd-controller: wifi_passphrase [secret]`.
[left] msg: Wi-Fi Passphrase: [secret]
[left] dbg: wait command...
[left] dbg: Received line: `cmd-controller: connect`.
[left] msg: Connect to Wi-Fi...
[left] dbg: .
[left] dbg: .
[left] no AP found
[left] dbg: .
[left] dbg: .
[left] no AP found
[left] dbg: .
[left] dbg: .
[left] dbg: .
[left] no AP found
[left] dbg: .
[left] dbg: .
[left] no AP found
[left] dbg: .
[left] dbg: .
[left] dbg: .
[left] no AP found
[left] dbg: .
[left] dbg: .
[left] no AP found
[left] dbg: .
[left] dbg: .
[left] no AP found
[left] dbg: .
[left] dbg: .
[left] dbg: .
[left] no AP found
[left] dbg: .
[left] dbg: .
[left] msg: Wi-Fi connected.
[left] cmd: Wi-Fi connected.
[left] dbg: wait command...
[Tellorche] Config file loaded. Input `exec` to start sequence:
exec
[Tellorche] Period: (1)...101:
[right] dbg: Received line: `cmd-tello: command`.
[top] dbg: Received line: `cmd-tello: command`.
[right] dbg: Send to tello: `command`.
[top] dbg: Send to tello: `command`.
[left] dbg: Received line: `cmd-tello: command`.
[right] dbg: Wait response from tello...
[top] dbg: Wait response from tello...
[left] dbg: Send to tello: `command`.
[left] dbg: Wait response from tello...
[right] dbg: Failed to decode bytes to string. Ignored.
[right] msg: Exception caught!
[right] dbg: Finally block. But connection isn't finalized!
[right] dbg: Send to tello: `emergency`.
[right] dbg: Wait response from tello...
[left] dbg: Failed to decode bytes to string. Ignored.
[right] dbg: Response received from tello: `ok` (7ms).
[left] msg: Exception caught!
[left] dbg: Finally block. But connection isn't finalized!
[right] Traceback (most recent call last):
[right]   File "main.py", line 156, in <module>
[top] dbg: Response received from tello: `ok` (55ms).
[left] dbg: Send to tello: `emergency`.
[right]   File "main.py", line 79, in main
[top] dbg: wait command...
[left] dbg: Wait response from tello...
[right]   File "main.py", line 79, in main
[right]   File "main.py", line 70, in main
[top] dbg: Received line: `cmd-tello: speed 100`.
[left] dbg: Response received from tello: `ok` (7ms).
[right]   File "main.py", line 128, in sendTelloCommand
[top] dbg: Send to tello: `speed 100`.
[top] dbg: Wait response from tello...
[left] Traceback (most recent call last):
[left]   File "main.py", line 156, in <module>
[right] AttributeError: 'NoneType' object has no attribute 'splitlines'
[left]   File "main.py", line 79, in main
[right] MicroPython v1.9.4 on 2018-05-11; ESP32 module with ESP32
[right] Type "help()" for more information.
[left]   File "main.py", line 79, in main
[left]   File "main.py", line 70, in main
[left]   File "main.py", line 128, in sendTelloCommand
[left] AttributeError: 'NoneType' object has no attribute 'splitlines'
[left] MicroPython v1.9.4 on 2018-05-11; ESP32 module with ESP32
[left] Type "help()" for more information.
[top] dbg: Response received from tello: `ok` (34ms).
[top] dbg: wait command...
[top] dbg: Received line: `cmd-tello: takeoff`.
[top] dbg: Send to tello: `takeoff`.
[top] dbg: Wait response from tello...
[top] dbg: Response received from tello: `ok` (4422ms).
[top] dbg: wait command...
[top] dbg: Received line: `cmd-tello: down 100`.
[top] dbg: Send to tello: `down 100`.
[top] dbg: Wait response from tello...
[top] dbg: Response received from tello: `ok` (3451ms).
[top] dbg: wait command...
[Tellorche] Period: (9900)...10000:
[top] dbg: Received line: `cmd-tello: cw 150`.
[top] dbg: Send to tello: `cw 150`.
[top] dbg: Wait response from tello...
[top] dbg: Response received from tello: `ok` (2611ms).
[top] dbg: wait command...
[Tellorche] Period: (14900)...15000:
[top] dbg: Received line: `cmd-tello: forward 20`.
[top] dbg: Send to tello: `forward 20`.
[top] dbg: Wait response from tello...
[top] dbg: Response received from tello: `ok` (671ms).
[top] dbg: wait command...
[Tellorche] Period: (19900)...20000:
[top] dbg: Received line: `cmd-tello: cw 120`.
[top] dbg: Send to tello: `cw 120`.
[top] dbg: Wait response from tello...
[top] dbg: Response received from tello: `ok` (2146ms).
[top] dbg: wait command...
[Tellorche] Period: (24900)...25000:
[top] dbg: Received line: `cmd-tello: forward 20`.
[top] dbg: Send to tello: `forward 20`.
[top] dbg: Wait response from tello...
[top] dbg: Response received from tello: `ok` (871ms).
[top] dbg: wait command...
[Tellorche] Period: (29900)...30000:
[top] dbg: Received line: `cmd-tello: cw 120`.
[top] dbg: Send to tello: `cw 120`.
[top] dbg: Wait response from tello...
[top] dbg: Response received from tello: `ok` (2145ms).
[top] dbg: wait command...
[Tellorche] Period: (34900)...35000:
[top] dbg: Received line: `cmd-tello: forward 20`.
[top] dbg: Send to tello: `forward 20`.
[top] dbg: Wait response from tello...
[top] dbg: Response received from tello: `ok` (1019ms).
[top] dbg: wait command...
[Tellorche] Period: (39900)...40000:
[top] dbg: Received line: `cmd-tello: cw -30`.
[top] dbg: Send to tello: `cw -30`.
[top] dbg: Wait response from tello...
[top] dbg: Response received from tello: `ok` (614ms).
[top] dbg: wait command...
[Tellorche] Period: (44900)...45000:
[Tellorche] All sequences was executed.
[top] dbg: Received line: `cmd-tello: land`.
[top] dbg: Send to tello: `land`.
[top] dbg: Wait response from tello...
[top] dbg: Response received from tello: `ok` (1830ms).
[top] dbg: wait command...
[top] dbg: Received line: `!reset`.
[top] msg: Disconnecting Wi-Fi...
[top] msg: Wi-Fi disconnected.
[top] cmd: Wi-Fi disconnected.
[top] msg: Tellorc
[left] >>> cmd-tello: speed 100cmd-tello: takeoffcmd-tello: down 100cmd-tello: cw 30cmd-tello: forward 20cmd-tello: cw 120cmd-tello: forward 20cmd-tello: cw 120cmd-tello: forward 20cmd-tello: cw 90cmd-tello: landbeacon timeout
[left] no AP found
[left] no AP found
[right] >>> cmd-tello: speed 100cmd-tello: takeoffcmd-tello: down 100cmd-tello: cw -90cmd-tello: forward 20cmd-tello: cw 120cmd-tello: forward 20cmd-tello: cw 120cmd-tello: forward 20cmd-tello: cw -150cmd-tello: land!resetbeacon timeout
[left] no AP found
[right] no AP found
[left] no AP found
[right] no AP found
[left] no AP found
[right] no AP found
[left] no AP found
[right] no AP found
[left] no AP found
[right] no AP found
[left] no AP found
[right] no AP found
Disconnected from the target VM, address: '127.0.0.1:50311', transport: 'socket'
Safe shutdown.

Process finished with exit code 130 (interrupted by signal 2: SIGINT)

実は既知の問題ではあるけど、非UnicodeパケットがTello本体から来ていてクラッシュした。この問題直さないとテストできそうにないなぁ

S64 commented 6 years ago

https://github.com/S64/tellorche/pull/66#issuecomment-438598439 の問題は #67 で対処した。 Tello本体の位置補正が @S64 の自宅ではかなりズレるものの、ざっくり動いてそうな雰囲気を感じる

S64 commented 6 years ago

マージします!