Today, after fixing some bugs in the polar feedback control loop. I decided to test the new control loop within the slope. I quickly coded a trajectory that makes the robot go up the slope, keeps it steady a couple of seconds and finally makes it go down. The result:
PS: sorry about the video quality, I didn’t have a better camera when doing the tests. I’ll try to post a better version soon.