Minor EKF tuning fix
Fixed generate starting direction
Added structures for arm and disarm logic