Implemented the VINSIDPController.
Added Pure VINS IDP to the MainDriver.