Completed basic implementation for ID-A*