Adding thrust factor to yaw correction according to Walt

These are the changes to the yaw calculations that Walt adds. 
It includes a value of 1.5 to dampen the yaw a bit. That seemed to work for Walt and me.