Fixed interrupt code. Version's working on DUE not on UNO not enough SRAM on UNO causes stack overflow.