Added interrupt code

Note, SD not supported in this version