In the video you can see that the robot stays at roughly the same spot on the floor and handles a lighter push without any problem. To achieve this I have two cascade PID controllers and low pass filter on both wheel speed and the robot’s angle.
Cool robot! Thank you for posting it. Thanks for putting up your source code on Github! Maybe you could use a Wixel and Wixel Shield for wireless control?