Main:add more test cases ; PSearch:use ArrayList instead of PriorityQ