Real-time visualization of cartesian position and orientation errors from dual-arm robot manipulators.
Install dependencies:
pip install -r requirements.txtRun the demo:
# Terminal 1: Run the demo error publisher
python demo_error_publisher.py
# Terminal 2: Run the visualizer
python cartesian_error_visualizer.pySubscribes to cartesian error topics and plots:
- Linear errors (X, Y, Z position) in meters
- Angular errors (Roll, Pitch, Yaw orientation) in radians
Topics:
right_arm/cartesian_errorleft_arm/cartesian_error
demo_error_publisher.py simulates realistic error variations:
- Converging trajectories
- Step responses with overshoot
- Oscillatory behavior
- Tracking errors
- Large movements
Cycles through scenarios every 5 seconds at 50 Hz.