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

Fix for joystick overflow on int16 conversion

Browse Source
This commit is contained in:
Stephen Merrony
2018-07-25 10:49:59 +02:00
parent 2241da4e53
commit 937675c6a4
1 changed files with 24 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

28
joystick.go
View File

@@ -175,10 +175,30 @@ func readJoystick(test bool) {
log.Printf("Error reading joystick: %v\n", err)
}
sm.Lx = int16(jsState.AxisData[jsConfig.axes[axLeftX]])
sm.Ly = int16(jsState.AxisData[jsConfig.axes[axLeftY]]) * -1
sm.Rx = int16(jsState.AxisData[jsConfig.axes[axRightX]])
sm.Ry = int16(jsState.AxisData[jsConfig.axes[axRightY]]) * -1
if jsState.AxisData[jsConfig.axes[axLeftX]] == 32768 {
sm.Lx = 32767
} else {
sm.Lx = int16(jsState.AxisData[jsConfig.axes[axLeftX]])
}
if jsState.AxisData[jsConfig.axes[axLeftY]] == 32768 {
sm.Ly = -32767
} else {
sm.Ly = -int16(jsState.AxisData[jsConfig.axes[axLeftY]])
}
if jsState.AxisData[jsConfig.axes[axRightX]] == 32768 {
sm.Rx = 32767
} else {
sm.Rx = int16(jsState.AxisData[jsConfig.axes[axRightX]])
}
if jsState.AxisData[jsConfig.axes[axRightY]] == 32768 {
sm.Ry = -32767
} else {
sm.Ry = -int16(jsState.AxisData[jsConfig.axes[axRightY]])
}
if intAbs(sm.Lx) < deadZone {
sm.Lx = 0
}