Design and implementation of sensing and estimation software in aggienav, a small UAV navigation platform