Advanced Locomotion System V3

I am having issues with rotation when lerping towards a door, if anyone has figured this out, please share.