Merge pull request #5 from saurabh1002/main

Minor fix to python API and gitignore

.gitignore

@@ -1,3 +1,3 @@
 __pycache__
-*/build/*
+**/build/*
 .vscode

mad_icp/apps/mad_icp.py

@@ -152,7 +152,8 @@ def main(data_path: Annotated[
                         p_th, b_min, b_ratio, num_keyframes, num_cores, realtime)
 
     estimate_file_name = estimate_path / "estimate.txt"
-    estimate_file = open(estimate_file_name, 'w')
+    estimate_file = open(estimate_file_name, 'a')
+    estimate_file.truncate(0)
 
     with InputDataInterface_lut[reader_type](data_path, min_range, max_range, topic=topic, sensor_hz=sensor_hz, apply_correction=apply_correction) as reader:
         t_start = datetime.now()

mad_icp/apps/utils/utils.py

@@ -31,7 +31,4 @@
 def write_transformed_pose(estimate_file, lidar_to_world, lidar_to_base):
 	base_to_lidar = np.linalg.inv(lidar_to_base)
 	base_to_world = np.dot(lidar_to_base, np.dot(lidar_to_world, base_to_lidar))
-	for row in range(3):
-		for col in range(4):
-			estimate_file.write(str(base_to_world[row, col]) + " ")
-	estimate_file.write("\n")
+	np.savetxt(estimate_file, base_to_world[:3].reshape(-1, 12))