added position correction after collision resolution, moved more functionality to vector component, fixed orientation and rotation calculations