Improved STLUtils header with const and iterator traits