CMS support

Added support for CMS sensors.
Started kalman based integration