Efficient algorithm for extended operational space inertia matrix | Synapse