move function getIntersectedObjects(Matrix, SituatedEntity) to class
SituatedEntity