Python example: lines-3d-geometry-example.py

This example illustrates some geometry functions:

 1#!/usr/bin/env python3
 2
 3# ---------------------------------------------------------------------
 4# Install python3-pymrpt, ros-$ROS_DISTRO-mrpt2, or test with a local build with:
 5# export PYTHONPATH=$HOME/code/mrpt/build-Release/:$PYTHONPATH
 6# ---------------------------------------------------------------------
 7
 8from mrpt import pymrpt
 9mrpt = pymrpt.mrpt
10
11# Aliases:
12TPoint3D = mrpt.math.TPoint3D_double_t
13TLine3D = mrpt.math.TLine3D
14
15l1 = TLine3D.FromTwoPoints(TPoint3D(0, 0, 0), TPoint3D(1, 0, 0))
16l2 = TLine3D.FromTwoPoints(TPoint3D(1, 1, 1), TPoint3D(2, 2, 0))
17
18print('l1             : ' + str(l1))
19print('l2             : ' + str(l2))
20print('dist(l1,l2)    : ' + str(mrpt.math.distance(l1, l2)))