Functions | Variables
calibration_estimation.error_visualization Namespace Reference

Functions

def usage ()
 

Variables

 a
 
 action
 
 all_sensor_types = list(set([x['sensor_type'] for x in all_sensors_dict.values()]))
 
 all_sensors_dict = est_helpers.build_sensor_defs(config[sensors_name])
 
 b
 
 bag_filename = rospy.myargv()[1]
 
list cam_covs = [matrix(array(s.compute_cov(fk)) * kron(eye(s.get_residual_length()/2),ones([2,2]))) for s,fk in zip(cam_sensors, fk_points)]
 
list cam_Js = [s.compute_expected_J(fk) for s,fk in zip(cam_sensors, fk_points)]
 
list cam_sensors = [[s for s in ms.sensors if s.sensor_id == cur_loop['cam']][0] for ms in multisensors_pruned]
 
list cb_points = [SingleTransform(pose).transform * system_def.checkerboards[ms.checkerboard].generate_points() for pose, ms in zip(cb_poses_pruned,multisensors_pruned)]
 
 cb_poses = yaml.load(open(output_dir + "/" + cur_step["output_filename"] + "_poses.yaml"))
 
 cb_poses_pruned
 
list chain_sensors = [[s for s in ms.sensors if s.sensor_id == cur_loop['3d']][0] for ms in multisensors_pruned]
 
 config = rospy.get_param(config_param_name)
 
string config_param_name = "calibration_config"
 
 cur_scatter = plt.scatter(array(r)[:,0], array(r)[:,1], **cur_loop['plot_ops'])
 
 cur_step = step_list[-1]
 
 e = error_calc.calculate_error(opt_all_vec)
 
 error_calc = opt_runner.ErrorCalc(system_def, free_dict, multisensors_pruned, False)
 
 error_cat = numpy.concatenate(error_list)
 
 errors_dict = opt_runner.compute_errors_breakdown(error_calc, multisensors_pruned, numpy.array(cb_poses_pruned))
 
list fk_covs = [matrix(array(s.compute_cov(None)) * kron(eye(s.get_residual_length()/3),ones([3,3]))) for s in chain_sensors]
 
list fk_points = [s.get_measurement() for s in chain_sensors]
 
 frame_id
 
 free_dict = yaml.load(cur_step["free_params"])
 
list full_covs = [matrix(cam_J)*fk_cov*matrix(cam_J).T + cam_cov for cam_J, cam_cov, fk_cov in zip(cam_Js, cam_covs, fk_covs)]
 
 g
 
int i = 0
 
 id
 
 label_list = list()
 
 loop_list = yaml.load(open(loop_list_filename))
 
 loop_list_filename = rospy.myargv()[3]
 
 m = Marker()
 
int marker_count = 0
 
 marker_pub = rospy.Publisher("calibration_error", Marker)
 
list meas_points = [s.get_measurement() for s in cam_sensors]
 
 multisensors = get_multisensors(bag_filename, sensor_defs, sample_skip_list)
 
 multisensors_pruned
 
 ns
 
 opt_all_vec = opt_runner.build_opt_vector(system_def, free_dict, numpy.array(cb_poses_pruned))
 
 output_dir = rospy.myargv()[2]
 
 points
 
list points_list_fk = [ geometry_msgs.msg.Point(cur_pt[0, 0], cur_pt[0, 1], cur_pt[0, 2]) for cur_pt in list(numpy.concatenate(fk_points,1).T)]
 
list points_list_guess = [ geometry_msgs.msg.Point(cur_pt[0, 0], cur_pt[0, 1], cur_pt[0, 2]) for cur_pt in list(numpy.concatenate(cb_points,1).T)]
 
list proj_points = [s.compute_expected(pts) for (s,pts) in zip(cam_sensors,fk_points)]
 
 prop
 
 r = numpy.concatenate((r1,r2),axis=0)
 
 r1 = numpy.concatenate(meas_points)
 
 r2 = numpy.concatenate(proj_points)
 
 rms_error = numpy.sqrt( numpy.mean(error**2) )
 
 robot_description = get_robot_description(bag_filename)
 
list sample_ind = [k for k,ms in zip(range(len(multisensors)), multisensors) if len(ms.sensors) == 2]
 
 sample_skip_list = rospy.get_param('calibration_skip_list', [])
 
list scatter_list = []
 
 sensor_defs = est_helpers.load_requested_sensors(all_sensors_dict, [cur_loop['cam'], cur_loop['3d']])
 
string sensors_name = "sensors"
 
 step_list = est_helpers.load_calibration_steps(config["cal_steps"])
 
 system_def = UrdfParams(robot_description, system_def_dict)
 
 system_def_dict = yaml.load(open(output_dir + "/" + cur_step["output_filename"] + ".yaml"))
 
 type
 
 x
 
 y
 
 z
 

Function Documentation

def calibration_estimation.error_visualization.usage ( )

Definition at line 56 of file error_visualization.py.

Variable Documentation

calibration_estimation.error_visualization.a

Definition at line 174 of file error_visualization.py.

calibration_estimation.error_visualization.action

Definition at line 169 of file error_visualization.py.

calibration_estimation.error_visualization.all_sensor_types = list(set([x['sensor_type'] for x in all_sensors_dict.values()]))

Definition at line 95 of file error_visualization.py.

calibration_estimation.error_visualization.all_sensors_dict = est_helpers.build_sensor_defs(config[sensors_name])

Definition at line 94 of file error_visualization.py.

calibration_estimation.error_visualization.b

Definition at line 173 of file error_visualization.py.

calibration_estimation.error_visualization.bag_filename = rospy.myargv()[1]

Definition at line 71 of file error_visualization.py.

list calibration_estimation.error_visualization.cam_covs = [matrix(array(s.compute_cov(fk)) * kron(eye(s.get_residual_length()/2),ones([2,2]))) for s,fk in zip(cam_sensors, fk_points)]

Definition at line 188 of file error_visualization.py.

list calibration_estimation.error_visualization.cam_Js = [s.compute_expected_J(fk) for s,fk in zip(cam_sensors, fk_points)]

Definition at line 187 of file error_visualization.py.

list calibration_estimation.error_visualization.cam_sensors = [[s for s in ms.sensors if s.sensor_id == cur_loop['cam']][0] for ms in multisensors_pruned]

Definition at line 157 of file error_visualization.py.

list calibration_estimation.error_visualization.cb_points = [SingleTransform(pose).transform * system_def.checkerboards[ms.checkerboard].generate_points() for pose, ms in zip(cb_poses_pruned,multisensors_pruned)]

Definition at line 159 of file error_visualization.py.

calibration_estimation.error_visualization.cb_poses = yaml.load(open(output_dir + "/" + cur_step["output_filename"] + "_poses.yaml"))

Definition at line 105 of file error_visualization.py.

calibration_estimation.error_visualization.cb_poses_pruned

Definition at line 124 of file error_visualization.py.

list calibration_estimation.error_visualization.chain_sensors = [[s for s in ms.sensors if s.sensor_id == cur_loop['3d']][0] for ms in multisensors_pruned]

Definition at line 156 of file error_visualization.py.

calibration_estimation.error_visualization.config = rospy.get_param(config_param_name)

Definition at line 87 of file error_visualization.py.

string calibration_estimation.error_visualization.config_param_name = "calibration_config"

Definition at line 83 of file error_visualization.py.

calibration_estimation.error_visualization.cur_scatter = plt.scatter(array(r)[:,0], array(r)[:,1], **cur_loop['plot_ops'])

Definition at line 202 of file error_visualization.py.

calibration_estimation.error_visualization.cur_step = step_list[-1]

Definition at line 100 of file error_visualization.py.

calibration_estimation.error_visualization.e = error_calc.calculate_error(opt_all_vec)

Definition at line 136 of file error_visualization.py.

calibration_estimation.error_visualization.error_calc = opt_runner.ErrorCalc(system_def, free_dict, multisensors_pruned, False)

Definition at line 134 of file error_visualization.py.

calibration_estimation.error_visualization.error_cat = numpy.concatenate(error_list)

Definition at line 151 of file error_visualization.py.

calibration_estimation.error_visualization.errors_dict = opt_runner.compute_errors_breakdown(error_calc, multisensors_pruned, numpy.array(cb_poses_pruned))

Definition at line 139 of file error_visualization.py.

list calibration_estimation.error_visualization.fk_covs = [matrix(array(s.compute_cov(None)) * kron(eye(s.get_residual_length()/3),ones([3,3]))) for s in chain_sensors]

Definition at line 189 of file error_visualization.py.

list calibration_estimation.error_visualization.fk_points = [s.get_measurement() for s in chain_sensors]

Definition at line 158 of file error_visualization.py.

calibration_estimation.error_visualization.frame_id

Definition at line 165 of file error_visualization.py.

calibration_estimation.error_visualization.free_dict = yaml.load(cur_step["free_params"])

Definition at line 106 of file error_visualization.py.

list calibration_estimation.error_visualization.full_covs = [matrix(cam_J)*fk_cov*matrix(cam_J).T + cam_cov for cam_J, cam_cov, fk_cov in zip(cam_Js, cam_covs, fk_covs)]

Definition at line 191 of file error_visualization.py.

calibration_estimation.error_visualization.g

Definition at line 172 of file error_visualization.py.

int calibration_estimation.error_visualization.i = 0

Definition at line 145 of file error_visualization.py.

calibration_estimation.error_visualization.id

Definition at line 167 of file error_visualization.py.

calibration_estimation.error_visualization.label_list = list()

Definition at line 111 of file error_visualization.py.

calibration_estimation.error_visualization.loop_list = yaml.load(open(loop_list_filename))

Definition at line 80 of file error_visualization.py.

calibration_estimation.error_visualization.loop_list_filename = rospy.myargv()[3]

Definition at line 73 of file error_visualization.py.

calibration_estimation.error_visualization.m = Marker()

Definition at line 164 of file error_visualization.py.

int calibration_estimation.error_visualization.marker_count = 0

Definition at line 110 of file error_visualization.py.

calibration_estimation.error_visualization.marker_pub = rospy.Publisher("calibration_error", Marker)

Definition at line 64 of file error_visualization.py.

list calibration_estimation.error_visualization.meas_points = [s.get_measurement() for s in cam_sensors]

Definition at line 194 of file error_visualization.py.

calibration_estimation.error_visualization.multisensors = get_multisensors(bag_filename, sensor_defs, sample_skip_list)

Definition at line 116 of file error_visualization.py.

calibration_estimation.error_visualization.multisensors_pruned

Definition at line 124 of file error_visualization.py.

calibration_estimation.error_visualization.ns

Definition at line 166 of file error_visualization.py.

calibration_estimation.error_visualization.opt_all_vec = opt_runner.build_opt_vector(system_def, free_dict, numpy.array(cb_poses_pruned))

Definition at line 135 of file error_visualization.py.

calibration_estimation.error_visualization.output_dir = rospy.myargv()[2]

Definition at line 72 of file error_visualization.py.

calibration_estimation.error_visualization.points

Definition at line 170 of file error_visualization.py.

list calibration_estimation.error_visualization.points_list_fk = [ geometry_msgs.msg.Point(cur_pt[0, 0], cur_pt[0, 1], cur_pt[0, 2]) for cur_pt in list(numpy.concatenate(fk_points,1).T)]

Definition at line 161 of file error_visualization.py.

list calibration_estimation.error_visualization.points_list_guess = [ geometry_msgs.msg.Point(cur_pt[0, 0], cur_pt[0, 1], cur_pt[0, 2]) for cur_pt in list(numpy.concatenate(cb_points,1).T)]

Definition at line 162 of file error_visualization.py.

list calibration_estimation.error_visualization.proj_points = [s.compute_expected(pts) for (s,pts) in zip(cam_sensors,fk_points)]

Definition at line 193 of file error_visualization.py.

calibration_estimation.error_visualization.prop

Definition at line 208 of file error_visualization.py.

calibration_estimation.error_visualization.r = numpy.concatenate((r1,r2),axis=0)

Definition at line 171 of file error_visualization.py.

calibration_estimation.error_visualization.r1 = numpy.concatenate(meas_points)

Definition at line 196 of file error_visualization.py.

calibration_estimation.error_visualization.r2 = numpy.concatenate(proj_points)

Definition at line 197 of file error_visualization.py.

calibration_estimation.error_visualization.rms_error = numpy.sqrt( numpy.mean(error**2) )

Definition at line 148 of file error_visualization.py.

calibration_estimation.error_visualization.robot_description = get_robot_description(bag_filename)

Definition at line 81 of file error_visualization.py.

list calibration_estimation.error_visualization.sample_ind = [k for k,ms in zip(range(len(multisensors)), multisensors) if len(ms.sensors) == 2]

Definition at line 125 of file error_visualization.py.

calibration_estimation.error_visualization.sample_skip_list = rospy.get_param('calibration_skip_list', [])

Definition at line 108 of file error_visualization.py.

list calibration_estimation.error_visualization.scatter_list = []

Definition at line 109 of file error_visualization.py.

calibration_estimation.error_visualization.sensor_defs = est_helpers.load_requested_sensors(all_sensors_dict, [cur_loop['cam'], cur_loop['3d']])

Definition at line 115 of file error_visualization.py.

string calibration_estimation.error_visualization.sensors_name = "sensors"

Definition at line 90 of file error_visualization.py.

calibration_estimation.error_visualization.step_list = est_helpers.load_calibration_steps(config["cal_steps"])

Definition at line 98 of file error_visualization.py.

calibration_estimation.error_visualization.system_def = UrdfParams(robot_description, system_def_dict)

Definition at line 104 of file error_visualization.py.

calibration_estimation.error_visualization.system_def_dict = yaml.load(open(output_dir + "/" + cur_step["output_filename"] + ".yaml"))

Definition at line 103 of file error_visualization.py.

calibration_estimation.error_visualization.type

Definition at line 168 of file error_visualization.py.

calibration_estimation.error_visualization.x

Definition at line 175 of file error_visualization.py.

calibration_estimation.error_visualization.y

Definition at line 176 of file error_visualization.py.

calibration_estimation.error_visualization.z

Definition at line 177 of file error_visualization.py.



calibration_estimation
Author(s): Vijay Pradeep, Michael Ferguson
autogenerated on Fri Apr 2 2021 02:12:53