修正云台指令码变焦速度编码错误

Lawrence

2020-06-10 76a75bf3d06b25cefee22245b4fb1eca0225f181

 src/main/java/com/genersoft/iot/vmp/gb28181/transmit/cmd/impl/SIPCommander.java

@@ -94,6 +94,51 @@
      return ptzCmd(device, channelId, 0, 0, inOut, 0, zoomSpeed);

   }

  

   /**

   * 云台指令码计算 
   *

    * @param leftRight  镜头左移右移 0:停止 1:左移 2:右移

    * @param upDown     镜头上移下移 0:停止 1:上移 2:下移

    * @param inOut      镜头放大缩小 0:停止 1:缩小 2:放大

    * @param moveSpeed  镜头移动速度 默认 0XFF (0-255)

    * @param zoomSpeed  镜头缩放速度 默认 0X1 (0-15)

    */

    public static String cmdString(int leftRight, int upDown, int inOut, int moveSpeed, int zoomSpeed) {

      int cmdCode = 0;

      if (leftRight == 2) {

         cmdCode|=0x01;      // 右移

      } else if(leftRight == 1) {

         cmdCode|=0x02;      // 左移

      }

      if (upDown == 2) {

         cmdCode|=0x04;      // 下移

      } else if(upDown == 1) {

         cmdCode|=0x08;      // 上移

      }

      if (inOut == 2) {

         cmdCode |= 0x10;   // 放大

      } else if(inOut == 1) {

         cmdCode |= 0x20;   // 缩小

      }

      StringBuilder builder = new StringBuilder("A50F01");

      String strTmp;

      strTmp = String.format("%02X", cmdCode);

      builder.append(strTmp, 0, 2);

      strTmp = String.format("%02X", moveSpeed);

      builder.append(strTmp, 0, 2);

      builder.append(strTmp, 0, 2);

      // strTmp = String.format("%X", zoomSpeed);

      int zs=(zoomSpeed<<4 & 0XF0);

      strTmp = String.format("%X", zs);

      builder.append(strTmp, 0, 1).append("0");

      //计算校验码

      int checkCode = (0XA5 + 0X0F + 0X01 + cmdCode + moveSpeed + moveSpeed + zs/*(zoomSpeed << 4 & 0XF0)*/) % 0X100;

      strTmp = String.format("%02X", checkCode);

      builder.append(strTmp, 0, 2);

      return builder.toString();

}





   /**

    * 云台控制，支持方向与缩放控制

    * 

@@ -109,13 +154,14 @@
   public boolean ptzCmd(Device device, String channelId, int leftRight, int upDown, int inOut, int moveSpeed,

         int zoomSpeed) {

      try {

         String cmdStr= cmdString(leftRight, upDown, inOut, moveSpeed, zoomSpeed);

         StringBuffer ptzXml = new StringBuffer(200);

         ptzXml.append("<?xml version=\"1.0\" ?>");

         ptzXml.append("<Control>");

         ptzXml.append("<CmdType>DeviceControl</CmdType>");

         ptzXml.append("<SN>" + (int)((Math.random()*9+1)*100000) + "</SN>");

         ptzXml.append("<DeviceID>" + channelId + "</DeviceID>");

         ptzXml.append("<PTZCmd>" + PtzCmdHelper.create(leftRight, upDown, inOut, moveSpeed, zoomSpeed) + "</PTZCmd>");

         ptzXml.append("<PTZCmd>" + cmdStr + "</PTZCmd>");

         ptzXml.append("<Info>");

         ptzXml.append("</Info>");

         ptzXml.append("</Control>");

@@ -123,7 +169,6 @@
         Request request = headerProvider.createMessageRequest(device, ptzXml.toString(), "ViaPtzBranch", "FromPtzTag", "ToPtzTag");

         

         transmitRequest(device, request);

			
         return true;

      } catch (SipException | ParseException | InvalidArgumentException e) {

         e.printStackTrace();