Improved VilmaDriver.

Now supports GPS and IMU. Code is cleaner and as KISS as I could imagine.
GUI is better too.