float F(optimAnchorPoint oap)
{
var v0 = oap.source;
// scale
var v1 = new Vk3(v0.x * scavek.x, v0.y * scavek.y, v0.z * scavek.z);
// rotate (just y for now)
var v2 = rotateY(rotvek.y, v1);
// translate
var v3 = v2 + trnvek;
var dt = v3 - oap.target;
float err = dt.x * dt.x + dt.y * dt.y + dt.z * dt.z;
return(err);
}
public void addOap(optimAnchorPoint oap)
{
oaplist.AddLast(oap);
}