恢复串口拍照从1开始取包

app/src/main/cpp/SensorsProtocol.cpp

@@ -2012,9 +2012,9 @@ void CameraPhotoPortDataProcess(int devno)
 			DebugLog(devparam[devno].commid, szbuf, 'V');
 			curserial->RevCmdFlag = 1;
 			pPortParam->FirstCmdTimeCnt = get_msec();
-			if ((iNo == pPortParam->SerialCmdidx-1) && (0xFF > rtumsg.MsgData[i + 2]))
+			if ((iNo == pPortParam->SerialCmdidx) && (0xFF > rtumsg.MsgData[i + 2]))
 			{
-				if (iNo == srdt.imagepacketnum-1)
+				if (iNo == srdt.imagepacketnum)
 				{   /* 检查是否有漏包*/
 					for (pidx = 0; pidx < srdt.imagepacketnum; pidx++)
 					{
@@ -2055,15 +2055,14 @@ void CameraPhotoPortDataProcess(int devno)
 						pPortParam->SerialCmdidx = -1;
 					}
 					else
-						pPortParam->SerialCmdidx = iNo+1;
-//					pPortParam->SerialCmdidx = iNo + 1;
+						pPortParam->SerialCmdidx = iNo + 1;
 				}
 				srdt.errorPhotoNoCnt = 0;
 				break;
 			}
 			srdt.errorPhotoNoCnt++;
 			sprintf(szbuf, "问询第%d包图片摄像机应答第%d包,连续错误%d次!",
-					pPortParam->SerialCmdidx-2, iNo, srdt.errorPhotoNoCnt);
+					pPortParam->SerialCmdidx, iNo, srdt.errorPhotoNoCnt);
 			DebugLog(devparam[devno].commid, szbuf, 'E');
 			if (srdt.errorPhotoNoCnt > 5)
 			{
@@ -2509,7 +2508,7 @@ int FindNextCameraPhotoCommand(int devidx)
 			return 1;
 		default:
 			imagesize = 0xFF;
-			packetsize = (uint16_t)srdt.ms_dev[devidx].SerialCmdidx-1;
+			packetsize = (uint16_t)srdt.ms_dev[devidx].SerialCmdidx;
 			cmdidx = 0x11;
 #if 0
 			if (0 == srdt.IsSleep)