Skip to main content

Evaluation of relative pose measurements.

Project description

cnspy_relative_pose_evaluation

A python3 package for evaluating relative pose measurements between two spatial frames in order to assess the accuracy. The baseline (ground truth) relative pose can be computed from two recorded 3D trajectories of the moving bodies and known extrinsics to the sensors. These can be specified in a single configuration file, see config.yaml

The following evaluations can be conducted:

Describtion Images
Pose Plot (left: measured, right: gt)
Pose Error Plot (left: position, right: orientation, top: meas, middle: error, bottom: nees)
Range (gt vs. measured) outliers removed
Range Sorted (gt vs. measured) outliers removed
Range Error (measured-gt) outliers removed
Range Error Histogram (filtered) and distribution
Angle (gt vs. measured) outliers set to zero
Angle Error (measured-gt) outliers removed
Angle Error Histogram (filtered) and distribution
Statistics statistics.yaml

Installation

Python 3.6 or greater is required. Inside this repo's directory, you may run

pip3 install .

or pip3 install -e . which installs the package in-place, allowing you make changes to the code without having to reinstall every time.

This package is still in development. Once stable it should be sufficient to run:

pip3 install cnspy_relative_pose_evaluation

Run from terminal

  • RelPoseMeasEvaluationTool
  • RelPoseMeasEvaluation
  • RelPose_ROSBag2CSV
  • ROSBag_TrueRelPoses
  • ROSBag_Poses2RelPose

YAML configuration file

YAML configuration file is in the form of:

# relative pose of the moving sensors
sensor_positions: {0:[0, 0, 0], 1:[0, 0, 0], 2:[0, 0, 0]}
sensor_orientations: {0:[1.0, 0, 0, 0], 1:[1.0, 0, 0, 0], 2:[1.0, 0, 0, 0]}
# true pose of the body
sensor_topics: {0: "/uav10/vrpn_client/raw_pose", 1: "/uav11/vrpn_client/raw_pose", 2: "/uav12/vrpn_client/raw_pose"}
# topcis of the relative pose measurement
relpose_topics: {0: "/uav10/data_handler/uvdar_fcu", 1: "/uav11/data_handler/uvdar_fcu", 2: "/uav12/data_handler/uvdar_fcu"}

Important notes for the NEES computation

The covariance of the measurements are assumed to represent the position uncertainty in meters and in the origin of reference frame of the observer, e.g. the camera. The covariance of the measured orientation is assumed to be in radian representing the uncertainty about the roll-pitch-yaw angles about the x-y-z-axes in zyx order (Rz(y)*Ry(p)*Rx(r)) of the body frame (local), thus EstimationErrorType.type5:

  • TRUE = EST + ERR for positions R(3);
  • TRUE = EST \oplus ERR for rotations SO(3);
  • global position error, local orientation error;.

Please check out: ErrorRepresentationType and EstimationErrorType

License

Software License Agreement (GNU GPLv3 License), refer to the LICENSE file.

Sharing is caring! - Roland Jung

Project details


Download files

Download the file for your platform. If you're not sure which to choose, learn more about installing packages.

Source Distribution

cnspy_relative_pose_evaluation-0.1.1.tar.gz (35.4 kB view details)

Uploaded Source

Built Distribution

File details

Details for the file cnspy_relative_pose_evaluation-0.1.1.tar.gz.

File metadata

File hashes

Hashes for cnspy_relative_pose_evaluation-0.1.1.tar.gz
Algorithm Hash digest
SHA256 83cc18d1b056f3d6dc4676d43d881ac3aaa8b634e6b795ff6b47126dcea23210
MD5 ca3dff822322c19baba23d6ca909305b
BLAKE2b-256 d8940688a1781192a3ed56094af7b640f373ac52a95e495e2b390bc8c980f6d1

See more details on using hashes here.

File details

Details for the file cnspy_relative_pose_evaluation-0.1.1-py3-none-any.whl.

File metadata

File hashes

Hashes for cnspy_relative_pose_evaluation-0.1.1-py3-none-any.whl
Algorithm Hash digest
SHA256 1d21d5def7faaa60a5b83afaf39aada8bb806ee4efcc0c4c3e0e0bf88db73e8b
MD5 912e0e0d2594ed88993f6652fb6150ac
BLAKE2b-256 bfaea483648897585e52743c6f8cec273a5270e3703bd2547d68971d577bd847

See more details on using hashes here.

Supported by

AWS AWS Cloud computing and Security Sponsor Datadog Datadog Monitoring Fastly Fastly CDN Google Google Download Analytics Microsoft Microsoft PSF Sponsor Pingdom Pingdom Monitoring Sentry Sentry Error logging StatusPage StatusPage Status page