Сменить систему координат массива точек

sub cross(a,b,c)
c(1)=a(2)*b(3)-a(3)*b(2)
c(2)=a(3)*b(1)-a(1)*b(3)
c(3)=a(1)*b(2)-a(2)*b(1)
end sub
 
sub norm(a)
m=1.0/sqr(a(1)*a(1)+a(2)*a(2)+a(3)*a(3))
a(1)=m*a(1)
a(2)=m*a(2)
a(3)=m*a(3)
end sub
 
sub matprod(p,a,b)
b(1)=p(1,1)*a(1)+p(1,2)*a(2)+p(1,3)*a(3)
b(2)=p(2,1)*a(1)+p(2,2)*a(2)+p(2,3)*a(3)
b(3)=p(3,1)*a(1)+p(3,2)*a(2)+p(3,3)*a(3)
end sub
 
N = 5
dim arr(3, 5)
arr(1,1)=50  : arr(2,1)=10  : arr(3,1)=0
arr(1,2)=70  : arr(2,2)=40  : arr(3,2)=-20
arr(1,3)=100 : arr(2,3)=-30 : arr(3,3)=10
arr(1,4)=40  : arr(2,4)=110 : arr(3,4)=-50
arr(1,5)=80  : arr(2,5)=-60 : arr(3,5)=30
 
dim a0(3), a1(3), a2(3), a3(3)
dim per(3,3)
 
a0(1)=arr(1,2)-arr(1,1)
a0(2)=arr(2,2)-arr(2,1)
a0(3)=arr(3,2)-arr(3,1)
a1(1)=arr(1,3)-arr(1,1)
a1(2)=arr(2,3)-arr(2,1)
a1(3)=arr(3,3)-arr(3,1)
 
cross a0,a1,a2
norm a1
norm a2
cross a1,a2,a3
' третий вектор уже не нужно нормировать, поскольку у нас были нормированы сомножители
 
' Транспонированная матрица перехода. Вектора нового базиса располагаем по строкам.
per(1,1)=a3(1)
per(1,2)=a3(2)
per(1,3)=a3(3)
per(2,1)=a1(1)
per(2,2)=a1(2)
per(2,3)=a1(3)
per(3,1)=a2(1)
per(3,2)=a2(2)
per(3,3)=a2(3)
 
' Пересчитываем координаты всех точек, кроме первой
for i=2 to N
a0(1)=arr(1,i)-arr(1,1)
a0(2)=arr(2,i)-arr(2,1)
a0(3)=arr(3,i)-arr(3,1)
matprod per, a0, a1
arr(1,i)=a1(1)
arr(2,i)=a1(2)
arr(3,i)=a1(3)
next
 
' Новые координаты первой точки
arr(1,1)=0
arr(2,1)=0
arr(3,1)=0
 
' Печать результата (закомментировано)
'msgbox arr(1,2)
'msgbox arr(2,2)
'msgbox arr(3,2)
'msgbox arr(1,3)
'msgbox arr(2,3)
'msgbox arr(3,3)
'msgbox arr(1,4)
'msgbox arr(2,4)
'msgbox arr(3,4)
'msgbox arr(1,5)
'msgbox arr(2,5)
'msgbox arr(3,5)