Fixed A star algorithm, added constant directive, and sort algorithm