Round 2 fixes: rotated fence corners, pt2line before Hough, incremental correction, loc_rms, dynamic decay

This commit is contained in:
cyy
2026-07-03 07:25:24 +00:00
parent 4f4715fb82
commit caaa18d30d
5 changed files with 56 additions and 47 deletions

View File

@@ -35,6 +35,9 @@ struct FenceModel {
// Pre-computed wall positions for localization
double left_x = -2.5, right_x = 2.5;
double bottom_y = -2.5, top_y = 2.5;
// Pre-computed corner points for drawing rotated fence
double p_lb_x=0, p_lb_y=0, p_lt_x=0, p_lt_y=0;
double p_rb_x=0, p_rb_y=0, p_rt_x=0, p_rt_y=0;
double yaw_field = 0.0;
double width = 0.0, height = 0.0;
double cx = 0.0, cy = 0.0;

View File

@@ -51,6 +51,7 @@ public:
// ── Layered map (fence + cone + dynamic) ──
void freezeSessionMap();
void composeLayers();
void decayDynamic(uint8_t amount = 10);
// ── Pre-built obstacle marks ───────────────────────
void markCircle(double wx, double wy, double radius, uint8_t value = 255);