x,y,headinng,sonar_ang,read,expected