Scalable, Multi-Sensor Aided Inertial Navigation For Agile Robots