Fixed message decoder function
Adding new subsystem handlers
Added support for new systems I've added