alihan/telloterm-drone
1
0
Fork 0
mirror of https://github.com/SMerrony/telloterm.git synced 2023-04-24 19:01:59 +03:00
Code Issues Packages Projects Releases Wiki Activity

Add support for logged velocity/position from drone

Browse Source
This commit is contained in:
Stephen Merrony
2018-06-16 14:06:55 +01:00
parent 44b7d37282
commit b822c6fa1b
1 changed files with 22 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

22
telloterm.go
View File

@@ -88,6 +88,12 @@ const (
fCameraState fCameraState
fDroneFlyTimeLeft fDroneFlyTimeLeft
fDroneBattLeft fDroneBattLeft
fVelX
fVelY
fVelZ
fPosX
fPosY
fPosZ
fSSID fSSID
fVersion fVersion
fNumFields fNumFields
@@ -130,6 +136,14 @@ func setupFields() {
fields[fDroneFlyTimeLeft] = field{label{24, 13, termbox.ColorWhite, termbox.ColorDefault, "Flight Remaining:"}, 42, 13, 6, termbox.ColorWhite, termbox.ColorDefault, "?"} fields[fDroneFlyTimeLeft] = field{label{24, 13, termbox.ColorWhite, termbox.ColorDefault, "Flight Remaining:"}, 42, 13, 6, termbox.ColorWhite, termbox.ColorDefault, "?"}
fields[fDroneBattLeft] = field{label{49, 13, termbox.ColorWhite, termbox.ColorDefault, "Battery Voltage:"}, 66, 13, 6, termbox.ColorWhite, termbox.ColorDefault, "?"} fields[fDroneBattLeft] = field{label{49, 13, termbox.ColorWhite, termbox.ColorDefault, "Battery Voltage:"}, 66, 13, 6, termbox.ColorWhite, termbox.ColorDefault, "?"}
fields[fVelX] = field{label{4, 16, termbox.ColorWhite, termbox.ColorDefault, "X Position:"}, 16, 16, 6, termbox.ColorWhite, termbox.ColorDefault, "?"}
fields[fVelY] = field{label{30, 16, termbox.ColorWhite, termbox.ColorDefault, "Y Position:"}, 42, 16, 6, termbox.ColorWhite, termbox.ColorDefault, "?"}
fields[fVelZ] = field{label{54, 16, termbox.ColorWhite, termbox.ColorDefault, "Z Position:"}, 66, 16, 6, termbox.ColorWhite, termbox.ColorDefault, "?"}
fields[fPosX] = field{label{4, 17, termbox.ColorWhite, termbox.ColorDefault, "X Velocity:"}, 16, 17, 6, termbox.ColorWhite, termbox.ColorDefault, "?"}
fields[fPosY] = field{label{30, 17, termbox.ColorWhite, termbox.ColorDefault, "Y Velocity:"}, 42, 17, 6, termbox.ColorWhite, termbox.ColorDefault, "?"}
fields[fPosZ] = field{label{54, 17, termbox.ColorWhite, termbox.ColorDefault, "Z Velocity:"}, 66, 17, 6, termbox.ColorWhite, termbox.ColorDefault, "?"}
fields[fSSID] = field{label{10, 22, termbox.ColorWhite, termbox.ColorDefault, "SSID: "}, 16, 22, 20, termbox.ColorWhite, termbox.ColorDefault, "?"} fields[fSSID] = field{label{10, 22, termbox.ColorWhite, termbox.ColorDefault, "SSID: "}, 16, 22, 20, termbox.ColorWhite, termbox.ColorDefault, "?"}
fields[fVersion] = field{label{56, 22, termbox.ColorWhite, termbox.ColorDefault, "Firmware: "}, 66, 22, 10, termbox.ColorWhite, termbox.ColorDefault, "?"} fields[fVersion] = field{label{56, 22, termbox.ColorWhite, termbox.ColorDefault, "Firmware: "}, 66, 22, 10, termbox.ColorWhite, termbox.ColorDefault, "?"}
@@ -417,6 +431,14 @@ func updateFields(newFd tello.FlightData) {
fields[fDroneFlyTimeLeft].value = fmt.Sprintf("%d", newFd.DroneFlyTimeLeft) fields[fDroneFlyTimeLeft].value = fmt.Sprintf("%d", newFd.DroneFlyTimeLeft)
fields[fDroneBattLeft].value = fmt.Sprintf("%dmV", newFd.BatteryMilliVolts) fields[fDroneBattLeft].value = fmt.Sprintf("%dmV", newFd.BatteryMilliVolts)
fields[fVelX].value = fmt.Sprintf("%d", newFd.VelocityX)
fields[fVelY].value = fmt.Sprintf("%d", newFd.VelocityY)
fields[fVelZ].value = fmt.Sprintf("%d", newFd.VelocityZ)
fields[fPosX].value = fmt.Sprintf("%f", newFd.PositionX)
fields[fPosY].value = fmt.Sprintf("%f", newFd.PositionY)
fields[fPosZ].value = fmt.Sprintf("%f", newFd.PositionZ)
fields[fSSID].value = newFd.SSID fields[fSSID].value = newFd.SSID
fields[fVersion].value = newFd.Version fields[fVersion].value = newFd.Version
} }