add diagnostic_msgs to manifest and stack