| | |
|---|
| | | self.origin_text = QtWidgets.QLineEdit(default_origin_short) |
|---|
| | | self.origin_text.setPlaceholderText("3949.9120,N,11616.8544,E[,alt]") |
|---|
| | | self.origin_btn = QtWidgets.QPushButton("更新原点") |
|---|
| | | self.copy_origin_btn = QtWidgets.QPushButton("复制宏定义") # 新增按钮 |
|---|
| | | grid.addWidget(QtWidgets.QLabel("坐标 (lat,N,lon,E):"), 0, 0, 1, 2) |
|---|
| | | grid.addWidget(self.origin_text, 0, 2, 1, 2) |
|---|
| | | grid.addWidget(self.origin_btn, 0, 4) |
|---|
| | | grid.addWidget(self.copy_origin_btn, 0, 5) # 添加到布局 |
|---|
| | | |
|---|
| | | labels = ["E (m)", "N (m)", "U (m)", "Heading (deg)"] |
|---|
| | | self.pos_spin: List[QtWidgets.QDoubleSpinBox] = [] |
|---|
| | |
|---|
| | | self.path_load_btn.clicked.connect(self._load_path_from_text) |
|---|
| | | self.path_export_btn.clicked.connect(self._export_path_to_mcu) |
|---|
| | | self.origin_btn.clicked.connect(self._update_origin) |
|---|
| | | self.copy_origin_btn.clicked.connect(self._copy_origin_macro) # 绑定事件 |
|---|
| | | self.reset_pose_btn.clicked.connect(self._reset_position) |
|---|
| | | self.port_refresh_btn.clicked.connect(self._refresh_serial_ports) |
|---|
| | | self.serial_toggle_btn.clicked.connect(self._toggle_serial) |
|---|
| | |
|---|
| | | self._set_controls_enabled(False) |
|---|
| | | self._update_serial_ui() |
|---|
| | | |
|---|
| | | def _copy_origin_macro(self): |
|---|
| | | text = self.origin_text.text().strip() |
|---|
| | | if not text: |
|---|
| | | QtWidgets.QMessageBox.warning(self, "复制", "原点输入框为空") |
|---|
| | | return |
|---|
| | | |
|---|
| | | # 格式: lat_val,N,lon_val,E,alt |
|---|
| | | # 例如: 3949.9120,N,11616.8544,E,47.5 |
|---|
| | | parts = [p.strip() for p in text.split(",")] |
|---|
| | | if len(parts) < 4: |
|---|
| | | QtWidgets.QMessageBox.warning(self, "复制", "原点格式错误，需至少包含经纬度") |
|---|
| | | return |
|---|
| | | |
|---|
| | | try: |
|---|
| | | # 解析 DDMM.MMMM 格式转 DD.DDDD |
|---|
| | | # 纬度 |
|---|
| | | lat_raw = parts[0] |
|---|
| | | lat_deg_int = int(float(lat_raw) / 100) |
|---|
| | | lat_min = float(lat_raw) % 100 |
|---|
| | | lat_dd = lat_deg_int + lat_min / 60.0 |
|---|
| | | if parts[1].upper() == 'S': |
|---|
| | | lat_dd = -lat_dd |
|---|
| | | |
|---|
| | | # 经度 |
|---|
| | | lon_raw = parts[2] |
|---|
| | | lon_deg_int = int(float(lon_raw) / 100) |
|---|
| | | lon_min = float(lon_raw) % 100 |
|---|
| | | lon_dd = lon_deg_int + lon_min / 60.0 |
|---|
| | | if parts[3].upper() == 'W': |
|---|
| | | lon_dd = -lon_dd |
|---|
| | | |
|---|
| | | # 高度 |
|---|
| | | alt = "0.0" |
|---|
| | | if len(parts) >= 5: |
|---|
| | | alt = parts[4] |
|---|
| | | |
|---|
| | | macro = ( |
|---|
| | | f"#define MC_CFG_ORIGIN_LAT_DEG ({lat_dd:.6f})\n" |
|---|
| | | f"#define MC_CFG_ORIGIN_LON_DEG ({lon_dd:.6f})\n" |
|---|
| | | f"#define MC_CFG_ORIGIN_ALT_M ({alt})" |
|---|
| | | ) |
|---|
| | | |
|---|
| | | clipboard = QtWidgets.QApplication.clipboard() |
|---|
| | | clipboard.setText(macro) |
|---|
| | | QtWidgets.QMessageBox.information(self, "复制", "已复制宏定义到剪贴板！") |
|---|
| | | |
|---|
| | | except ValueError as e: |
|---|
| | | QtWidgets.QMessageBox.warning(self, "复制", f"数值解析错误: {e}") |
|---|
| | | |
|---|
| | | def _handle_user_pan(self): |
|---|
| | | if self._auto_follow: |
|---|
| | | self.follow_checkbox.blockSignals(True) |
|---|
