fix turning bug and add robot pos mark