fix yaw calculation. closes #4