laser_check

Flowerst-0416 · Dec 6, 2022 · 3125eff · 3125eff
1 parent 9f92277
commit 3125eff
Show file tree

Hide file tree

Showing 3 changed files with 9 additions and 3 deletions.
diff --git a/multi_calibration/launch/auto_calibration.launch b/multi_calibration/launch/auto_calibration.launch
@@ -66,5 +66,7 @@
         <group if="$(eval arg('laser_cam') == 2)">
         <node name="foo" pkg="multi_calibration" type="laser.sh" output="screen" />
     </group>
-
+        <group if="$(eval arg('laser_cam') == 3)">
+        <node pkg="multi_calibration" name="laser_cali" type="vis_laser_calib_result.py" output="screen"/>
+    </group>
 </launch>
diff --git a/multi_calibration/scrip/laser.sh b/multi_calibration/scrip/laser.sh
@@ -5,3 +5,4 @@ source devel/setup.bash
 echo "[INFO] Calibrating camera-laser extrinsic. "
 rosrun multi_calibration Extrinsic_filter.py
 rosrun multi_calibration laser_calib -i ~/Calibration_ws/src/UR_arm_camera_calibration/multi_calibration/laser/Target_Image -c ~/Calibration_ws/src/UR_arm_camera_calibration/multi_calibration/cfg/laser_calib.yaml
+mv ./calib_results.txt ~/Calibration_ws/src/UR_arm_camera_calibration/multi_calibration/cfg/calib_results.txt
diff --git a/multi_calibration/scrip/vis_laser_calib_result.py b/multi_calibration/scrip/vis_laser_calib_result.py
@@ -1,11 +1,13 @@
-#!/usr/bin/env python
+#!/usr/bin/env python3
 # coding: utf-8
 
 import numpy as np
 from matplotlib import pyplot as plt
 from mpl_toolkits.mplot3d import axes3d, Axes3D
 import math
 import sys
+import os
+import glob
 
 def draw_frame(ax, R, t):
     axis_len = 0.05
@@ -22,7 +24,8 @@ def draw_frame(ax, R, t):
 
 
 # read plane parameters and laser points
-result_file = open(sys.argv[1])
+Home_path = os.path.expanduser('~') 
+result_file = open(Home_path +"/Calibration_ws/src/UR_arm_camera_calibration/multi_calibration/cfg/calib_results.txt")
 raw_data = result_file.readlines()
 plane_params = np.fromstring(raw_data[1].strip(), dtype=float, sep=',')
 print(plane_params)