nat_pos_minus_pos_cpp function

Subtracts two natPositions to obtain the natVelocity that transforms ps1 into ps2