The Point struct is defined as:
struct Point
idx::Int16
transform_idx::Int16 # idx of wing used for initial orientation
wing_idx::Int16
pos_cad::KVec3
pos_b::KVec3 # pos relative to wing COM in body frame
pos_w::KVec3 # pos in world frame
vel_w::KVec3 # vel in world frame
type::DynamicsType
end
It stores three position vectors, even though a point can only have one and only one position.
This smells.