Unnecessary rotate while rmf enter lift (#390)

Posted by @StetroF:

As the topic.After robot enter lift. The best options is to do nothing because it’s too narrow in lift. But every time robot enter lift. It will have a 50 degree’s rotate which is not safe if there is a people in lift. I wonder what cause it ? Here is the Video:
Rotate after enter lift.webm
In the 55 -60 seconds. You will see that robot have a rotate comannd.