fixed small bug in vicon rotation code