Robust robot docking with lidar only
Hello, I'm looking on advice on how I can improve my robot docking algorithm.
I only have a lidar to work with, and I use a kobuki base.
Currently, the robot is able to detect a triangle-shaped dock and move towards the middle of it using a PD controller.
However, this approach does not consider how centered it is with respect to the dock. What I mean is that I have no control to check whether the robot is approaching the dock perpendicularly, which is needed to make contact with the charger.
Any ideas on how to add this into my code?