Add TestTopocentric3DPoint and update TestTopocentric2DPoint