Plot positions and camera axes, noted problem with velocities vx, vy (possibly not in body axes but ground speed)