RTI + RTS fixed by adding state. ISR working