Check that Body id and Joint id are not less than zero in MultiBodyGraph.