Path planning for a differential drive robot