Add blocking detection
Add a blocking detection that stops both motors when the robot is stuck against an obstacle. The threshold can be tweaked using the ros parameters.
Add a blocking detection that stops both motors when the robot is stuck against an obstacle. The threshold can be tweaked using the ros parameters.