Very easy solution: Tree Planning - #125 by KentStuff
download this version from KentStuff and set fix 2 fix to 0.5
there is also a kalman filter in the heading that you can disable in option if you want.
You can set fix to fix even lower, like 0.1 , it is perfect for planting veggies if don’t have dual antenna setup.