+
+ // R0: Temp
+ // R1: Byte to write
+ // R2: Buffer size
+ // R3: Position
+ {UDI_PIO_LOAD_IMM+UDI_PIO_DIRECT+UDI_PIO_R3, UDI_PIO_2BYTE, 0},
+ {UDI_PIO_LOAD_IMM+UDI_PIO_DIRECT+UDI_PIO_R0, UDI_PIO_2BYTE, 0},
+ {UDI_PIO_LOAD+UDI_PIO_MEM+UDI_PIO_R0, UDI_PIO_4BYTE, UDI_PIO_R2},
+
+ {UDI_PIO_LABEL, 0, 1}, // Loop top
+
+ {UDI_PIO_STORE+UDI_PIO_DIRECT+UDI_PIO_R0, UDI_PIO_2BYTE, UDI_PIO_R3},
+ //PIO_op_RI(LOAD, R0, 2, UDI_PIO_R3),
+ PIO_op_RI(SUB, R0, 2, UDI_PIO_R2),
+ {UDI_PIO_CSKIP+UDI_PIO_R0, UDI_PIO_1BYTE, UDI_PIO_NZ},
+ {UDI_PIO_BRANCH, 0, 3},
+
+ // Load byte into R1 (and increment R3)
+ {UDI_PIO_LOAD+UDI_PIO_BUF+UDI_PIO_R3, UDI_PIO_1BYTE, UDI_PIO_R1},
+ PIO_op_RI(ADD_IMM, R3, 2, 1),
+
+ // TX single byte from R1
+ // - Wait for FIFO to clear
+ // while( (inb(SERIAL_PORT + 5) & 0x20) == 0 );
+ {UDI_PIO_LABEL, 0, 2},
+ PIO_IN_RI1(R0, 5),
+ PIO_op_RI(AND_IMM, R0, 1, 0x20),
+ {UDI_PIO_CSKIP+UDI_PIO_R0, UDI_PIO_1BYTE, UDI_PIO_NZ},
+ {UDI_PIO_BRANCH, 0, 2},
+ // - TX
+ // outb(SERIAL_PORT, ch);
+ PIO_OUT_RI1(R1, 0),
+ {UDI_PIO_BRANCH, 0, 1},
+
+ // Done
+ {UDI_PIO_LABEL, 0, 3},