优化飞行轨迹

liusuyi

2025-12-25 a7de52f612afd19e76909635bc273aa502698b2e

 ard-work/src/main/java/com/ard/work/service/impl/ArdFlightTaskPartServiceImpl.java

@@ -14,10 +14,13 @@
import org.springframework.scheduling.annotation.Async;
import org.springframework.scheduling.annotation.Scheduled;
import org.springframework.stereotype.Service;

import java.util.ArrayList;
import java.util.Comparator;
import java.util.Date;
import java.util.List;
import java.util.concurrent.ConcurrentHashMap;

/**
 * 轨迹分片处理业务
 */
@@ -27,7 +30,8 @@
public class ArdFlightTaskPartServiceImpl implements IArdFlightTaskPartService {

    private final ArdFlightTaskPartMapper ardflightTaskPartMapper;

    // 上一次飞行状态缓存
    private final ConcurrentHashMap<String, Integer> lastFlightStatusMap = new ConcurrentHashMap<>();
    /**
     * 缓存：boxSn -> 当前分片数据
     */
@@ -59,18 +63,20 @@
                return; // 超过 3 秒没有新遥测 → 认为已离线或冻结，不记录
            }

            // 3️⃣ 飞行状态必须是飞行中
            if(uavState.getFlightControllerState().getFlightStatus()!=2)
            {
                return; // 飞行状态不是飞行中，不记录
            }
            int currentStatus = uavState.getFlightControllerState().getFlightStatus();
            Integer lastStatus = lastFlightStatusMap.get(boxSn);

            UavFlightStateDTO dto = new UavFlightStateDTO(
                    uavState,
                    telemetryData,
                    dataTs
            );
            addTelemetryData(dto);
            // 仅在“飞行中 → 非飞行中”状态变化时 flush
            if (lastStatus != null && lastStatus == 2 && currentStatus != 2) {
                flushRemaining(boxSn);
            }
            lastFlightStatusMap.put(boxSn, currentStatus);

            // 只有飞行中才添加缓存
            if (currentStatus == 2) {
                UavFlightStateDTO dto = new UavFlightStateDTO(uavState, telemetryData, dataTs);
                addTelemetryData(dto);
            }
        });
    }

@@ -101,16 +107,17 @@

        try {
            byte[] blobData = SerializeUtil.serialize(dataList);

            // 取第一个和最后一个状态时间
            long startTs = dataList.get(0).getTimestamp();
            long endTs = dataList.get(dataList.size() - 1).getTimestamp();
            ArdFlightTaskPart part = ArdFlightTaskPart.builder()
                    .boxSn(boxSn)
                    .count(dataList.size())
                    .dataPart(blobData)
                    .startTime(new Date(startTs))
                    .endTime(new Date(endTs))
                    .build();
            // 使用 list 中第一条数据的时间作为 createTime
            long firstTimeMillis = dataList.get(0).getTimestamp();
            Date createTime = new Date(firstTimeMillis);
            part.setCreateTime(createTime);
            part.setCreateTime(new Date());
            ardflightTaskPartMapper.insert(part);

            log.info("设备 {} 分片保存 {} 条飞行数据到数据库成功", boxSn, dataList.size());
@@ -142,7 +149,7 @@
    public List<UavFlightStateDTO> getCompleteFlightData(ArdFlightTaskPart ardFlightTaskPart) {
        List<UavFlightStateDTO> allData = new ArrayList<>();
        String boxSn = ardFlightTaskPart.getBoxSn();
        List<ArdFlightTaskPart> parts = ardflightTaskPartMapper.selectByTaskStartTime(ardFlightTaskPart);
        List<ArdFlightTaskPart> parts = ardflightTaskPartMapper.selectByTimeRange(ardFlightTaskPart);
        for (ArdFlightTaskPart part : parts) {
            try {
                List<UavFlightStateDTO> partData = SerializeUtil.deserialize(part.getDataPart());
@@ -151,6 +158,9 @@
                log.error("反序列化 boxSn={} 分片数据失败", boxSn, e);
            }
        }
        // 按 telemetryData.timestamp 升序排序
        allData.sort(Comparator.comparingLong(dto -> dto.getTelemetryData().getTimestamp()));

        return allData;
    }
}