gy86 test fixes
gy86 test fixes

murix/beaglebonequadcopter,murix/beaglebonequadcopter,murix/beaglebonequadcopter,murix/beaglebonequadcopter,murix/beaglebonequadcopter,murix/beaglebonequadcopter,murix/beaglebonequadcopter