Function read_gps_csv

ToolBox/icp_python/script.py:188–203

从CSV读取GPS数据

(csv_path, target_time)

    log_info(f"失败文件: {total_files-success_files} ({(total_files-success_files)/total_files:.1%})")

def read_gps_csv(csv_path, target_time):
    """从CSV读取GPS数据"""
    target_time_int = int(round(target_time * 10))
    try:
        with open(csv_path, 'r') as f:
            reader = csv.DictReader(f)
            for row in reader:
                if int(row['Time']) == target_time_int:
                    return [
                        float(row['Latitude']),
                        float(row['Longitude']),
                        0.0,  # 海拔暂设为0
                        float(row['heading'])
                    ]
    except:
        return None

def read_imu_csv(csv_path, target_time):
    """从CSV读取IMU数据"""