浏览代码

修改键盘遥控云台转动代码,使上下转动舵机可以正常转动

corvin rasp melodic 3 年之前
父节点
当前提交
010d33d0f7
共有 1 个文件被更改,包括 2 次插入4 次删除
  1. 2 4
      src/teleop_twist_keyboard/teleop_twist_keyboard.py

+ 2 - 4
src/teleop_twist_keyboard/teleop_twist_keyboard.py

@@ -22,7 +22,6 @@ Moving around:
    j    k    l
         ,
 
-
 anything else : stop
 
 q/z : increase/decrease max speeds by 10%
@@ -109,7 +108,6 @@ if __name__=="__main__":
     status = 0
     upDownAngle = 90
     leftRightAngle = 90
-    command = 2
 
     try:
         print(msg)
@@ -135,7 +133,7 @@ if __name__=="__main__":
                 z = 0
                 th = 0
                 print(angles(upDownAngle))
-                if (upDownAngle < 180 and upDownAngle >=0):
+                if (upDownAngle <= 180 and upDownAngle > 0):
                     upDownAngle = upDownAngle + cameraUpBindings[key]
                     client_srv(1, upDownAngle)
             elif key in cameraDownBindings.keys():
@@ -144,7 +142,7 @@ if __name__=="__main__":
                 z = 0
                 th = 0
                 print(angles(upDownAngle))
-                if (upDownAngle <= 180 and upDownAngle >0):
+                if (upDownAngle < 180 and upDownAngle >= 0):
                     upDownAngle = upDownAngle + cameraDownBindings[key]
                     client_srv(1, upDownAngle)
             elif key in cameraLeftBindings.keys():