First Edit of no vicon. Small bug with rotation correction using average