Mercurial > hg > orthanc-stone

view Resources/Computations/IntersectSegmentAndVerticalLine.py @ 676:1b47f17863ba am-dev

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
codegen: using an ordereddict loader instead of sort the keys -> the delcared ordered in the yaml is preserved in the generated code which is more meaningfull than the alphabetical order
author Alain Mazy <alain@mazy.be>
date Thu, 16 May 2019 09:49:30 +0200
parents 35c2b85836ce
children
line wrap: on
line source

#!/usr/bin/env python

from sympy import *

# Intersection between the 2D line segment (prevX,prevY)-(curX,curY) and the
# vertical line "x = x0" using homogeneous coordinates

prevX, prevY, curX, curY, x0 = symbols('prevX prevY curX curY x0')

p1 = Matrix([prevX, prevY, 1])
p2 = Matrix([curX, curY, 1])
l1 = p1.cross(p2)

h1 = Matrix([x0, 0, 1])
h2 = Matrix([x0, 1, 1])
l2 = h1.cross(h2)

a = l1.cross(l2)

pprint(a / a[2])