Code cleanup, improved SimuLinkStub to send mor realistic data