[simple_robot] debug angle reconstruction (still not valid)