points.push(record_to_point(&record));
}
- dbg!(points);
+ dbg!(&points);
+
+ let grid = points_to_grid(&points);
+
+ dbg!(&grid);
Ok(())
}
let cart_pos = Point2::new(record.cart_pos.0, record.cart_pos.1);
let cart_rot = Rotation2::new(record.cart_rot);
- let distance: Vector2<f64> = (cart_rot * Vector2::new(0.0, 1.0)) * record.distance;
+ let distance: Vector2<f64> = (cart_rot * Vector2::new(1.0, 0.0)) * record.distance;
Point2::from(distance + Vector2::from(cart_pos.coords))
}
fn points_to_grid(points: &Vec<Point2<f64>>) -> Grid {
- let mut grid = Grid::new(0.1, HashMap::new());
+ let mut grid = Grid::new(0.5, HashMap::new());
for point in points {
let coords = (
- (point.x % grid.resolution) as i32,
- (point.y % grid.resolution) as i32,
+ (point.x / grid.resolution) as i32,
+ (point.y / grid.resolution) as i32,
);
grid.strengths.insert(
coords,