спасибо за поддержку, а то какой то мозговой ступор был. Действительно спасибо.
Алгоритм отсюда
http://algolist.manual.ru/maths/geom...ineplain3d.php
Несколько функций подсмотрено где поближе что лежало
sandy.core.data.Vector
com.robertpenner.geom.Vector3d//кстати, кто там матрицу для поворота спрашивал
На первый взгляд - работает как надо, а более детально это уже в системе посмотрю