Even with the lidar, it seems like there is still a fair amount of wall collisions as it travels parallel down the wall. Have an option of specifying the thickness of the baseboards so it knows to account for the fact that the lidar is measuring distance to the wall above the baseboard.
[Mod Edit]: Title Modified to Enhance Search Clarity.