Working on getting IHU Simulator working
Need the actual ICD to fix uart and simulator