small fix to baro state filter - more init cycles
fixes to barofilter
fixed signs in control loop