Changed print result and added method to draw solution path in red to the img