Adding lidar sensor handling

2026-07-08 20:58:21 -06:00
parent 8fc5088c01
commit 04f3e2ba07
19 changed files with 145 additions and 31 deletions
@@ -24,8 +24,9 @@ func _update_data():
 		return
 	var lateral_gs = host_vehicle.lateral_accel
 	var accel_g = lateral_gs.length() / Constants.g
-	var x_vec = Vector2(lateral_gs.x, 0)
-	accel_vector.points = [origin, lateral_gs * 4]
-	x_vector.points = [origin, x_vec * 4]
-	y_vector.points = [x_vec * 4, lateral_gs * 4]
+	var end_point = Vector2(lateral_gs.y, -lateral_gs.x)
+	var forward = Vector2(0, -lateral_gs.x)
+	accel_vector.points = [origin, end_point * 4]
+	x_vector.points = [forward * 4, end_point * 4]
+	y_vector.points = [origin, forward * 4]
 	label.text = str(round(accel_g*10)/10) + ' g'