Changes, fixes to Incendio A5

Still ongoing.