First pole pos = 0.373186
Yaw = 0.003037
X = 0.026440
Pitch = -0.001687
Y = 0.000288