diff --git a/scripts/publisher_camera_info.py b/scripts/publisher_camera_info.py index 6a38fd461d9c048e36e42d2a38551e93f90b05ce..386c882b87343cb35aeb3349e4fc85b76fcc215a 100644 --- a/scripts/publisher_camera_info.py +++ b/scripts/publisher_camera_info.py @@ -1,25 +1,8 @@ #!/usr/bin/env python3 -import sys -import copy -from pure_eval import CannotEval import yaml -import numpy as np import rospy -from sensor_msgs.msg import CameraInfo -from sensor_msgs.msg import Image +from sensor_msgs.msg import CameraInfo, Image -def kvec2mat(fx, fy, cx, cy): - return np.array([ - fx, 0, cx, - 0, fy, cy, - 0, 0, 0 -]).reshape((3,3)) - - -def kmat2vec(K): - # fx, fy, cx, cy - return [K[0,0], K[1,1], K[0,2], K[1,2]] - class CameraInfoPublisher: