Added entity_get_pos and improved entity find