Add reset tests in test harness
Add reset tests in test harness

zlongshen/InertialNav,vergil1874/InertialNav,ek99800/InertialNav,ek99800/InertialNav,zlongshen/InertialNav,priseborough/InertialNav,ek99800/InertialNav,vergil1874/InertialNav,priseborough/InertialNav,flyingk/InertialNav,AlexHAHA/InertialNav,AlexHAHA/InertialNav,flyingk/InertialNav,flyingk/InertialNav,vergil1874/InertialNav,priseborough/InertialNav,priseborough/InertialNav,zlongshen/InertialNav,flyingk/InertialNav,AlexHAHA/InertialNav