Function check_index 

pub fn check_index(index: usize, max: usize) -> PhysicsResult<usize>

Returns Ok(index) if index < max, otherwise Err(OutOfBounds).