메뉴
VIO (Visual Inertial Odometry) data processing utilities for SE(3) pose conversion and 3D visualization. Use when working with SE(3) matrices and need pose representation conversion (tx,ty,tz,qw,qx,qy,qz), 3D visualization of pose trajectories with orientation arrows, or Visual Inertial Odometry data transformation and analysis
Codex 또는 Claude로 설치 이 Prompt를 복사해 Codex, Claude 또는 다른 어시스턴트에 붙여 넣으면 Skill 페이지를 검토하고 설치를 진행할 수 있습니다.
SOC 직업 분류 기준
Configure common development commands and local tool environments with pywayne's toolsetup CLI. Use whenever the user mentions toolsetup, cross-platform shell shortcuts, proxy_on/proxy_off, persistent goto aliases, the Linux gpu helper, nvm/npm bootstrap, Linux Tailscale installation, or MongoDB/PyMongo setup on macOS or Linux—even if they only ask for the right command or a dry-run plan.
Fetch and install C++ tools/libraries from cpp_tools repository. Use when users need to download or clone third-party C++ libraries such as eigen, opencv, pcl, fmt. Use for building tools from source using CMake, installing tools with installation scripts, listing available tools, or managing cpp_tools repository URL. Triggered by requests to fetch, get, download, clone, or install C++ tools or libraries.
Sensor calibration toolkit with magnetometer calibration using close-form method. Use when calibrating IMU sensors (accelerometer, gyroscope, magnetometer) to compute soft-iron matrix and hard-iron offset for magnetometer correction. Requires sensor fusion with VQF for orientation estimation.
Digital signal processing toolkit for filtering, peak detection, detrending, and curve similarity. Use when working with sensor data, signal preprocessing, feature extraction, noise suppression, or time-series analysis. Includes Butterworth filter, One-Euro filter, signal detrending, DTW curve similarity, Welford standard deviation, and sliding window extrema detection.
SE(3) rigid body transformation library for 3D rotation and translation operations. Use when working with robot poses, camera transformations, SLAM systems, or any 3D rigid body motion tasks. Supports SE(3) matrix operations, Lie group/algebra mappings (log/Log, exp/Exp), representation conversions (quaternion, axis-angle, Euler angles), and batch processing of trajectories.
Analyze and visualize Git commit time distribution. Use when users need to analyze Git repository commit patterns, generate commit statistics, visualize commit activity by time, hour, or weekday. Triggered by requests to analyze commits, show commit distribution, visualize Git activity, or generate commit time statistics.
| name | pywayne-vio-tools |
| description | VIO (Visual Inertial Odometry) data processing utilities for SE(3) pose conversion and 3D visualization. Use when working with SE(3) matrices and need pose representation conversion (tx,ty,tz,qw,qx,qy,qz), 3D visualization of pose trajectories with orientation arrows, or Visual Inertial Odometry data transformation and analysis |
Provides utilities for VIO data processing: convert between SE(3) transformation matrices and pose representations, and visualize pose trajectories in 3D with orientation indicators.
from pywayne.vio.tools import SE3_to_pose, pose_to_SE3, visualize_pose
import numpy as np
# Convert SE(3) to pose
SE3 = np.eye(4) # Single 4x4 SE(3) matrix
pose = SE3_to_pose(SE3) # Returns [tx, ty, tz, qw, qx, qy, qz]
# Batch conversion
SE3_array = np.random.randn(10, 4, 4) # 10 SE(3) matrices
poses = SE3_to_pose(SE3_array)
# Convert back to SE(3)
SE3_recon = pose_to_SE3(pose)
# Visualize poses
visualize_pose(poses) # 3D plot with position markers and orientation arrows
Convert SE(3) transformation matrices to pose representation.
Input: SE3_mat - Single 4x4 SE(3) matrix or array of N SE(3) matrices shape (N, 4, 4)
Output: pose - Array shape (1, 7) or (N, 7) containing [tx, ty, tz, qw, qx, qy, qz]. A single input preserves the historical length-1 batch dimension.
Dependencies: qmt.quatFromRotMat() for quaternion extraction
Convert pose representation back to SE(3) transformation matrices.
Input: pose_mat - Single pose shape (7,) or array of N poses shape (N, 7) with [tx, ty, tz, qw, qx, qy, qz]
Output: SE3_mat - Array of SE(3) matrices shape (1, 4, 4) or (N, 4, 4). A single input preserves the historical length-1 batch dimension.
Dependencies: qmt.quatToRotMat(), ahrs.Quaternion
3D visualization of SE(3) poses with position markers and orientation arrows.
Parameters:
poses: Array of poses [tx, ty, tz, qw, qx, qy, qz]arrow_length_ratio: Scale factor for orientation arrows (default: 0.1)Visualization:
Dependencies: matplotlib.pyplot, qmt.quatToRotMat()
[[R00 R01 R02 tx]
[R10 R11 R12 ty]
[R20 R21 R22 tz]
[ 0 0 0 1]]
[tx, ty, tz, qw, qx, qy, qz]
Translation: tx, ty, tz (meters) Quaternion: qw, qx, qy, qz (Hamilton convention)
Required packages:
numpy - Array operationsqmt - Quaternion utilitiesahrs - Quaternion classmatplotlib - 3D visualizationInstall with:
pip install numpy qmt ahrs matplotlib