Console Output

 fix bug, calculated yaw compensation using previous atr