hw/char/pl011: Enable TxFIFO and async transmission
PATCH v2 1/1 hw/char/pl011: Enable TxFIFO and async transmission
The depth of TxFIFO can be 1 or 16 depending on LCR[4]. The TxFIFO is disabled when its depth is 1. It's nice to have TxFIFO enabled if possible because more characters can be piled and transmitted at once, which would have less overhead. Besides, we can be blocked because of qemu_chr_fe_write_all(), which isn't nice.
This enables TxFIFO if possible. On ther other hand, the asynchronous transmission is enabled if needed, as we did in hw/char/cadence_uart.c
---
v2: Put write_{count,fifo} into migration subsection
Don't start async IO handle if it has been started, to avoid race Update with PL011_FLAG_{TXFF,TXFE} on changing write_count
--- hw/char/pl011.c | 105 +++++++++++++++++++++++++++++++++++++--- include/hw/char/pl011.h | 3 ++ 2 files changed, 102 insertions(+), 6 deletions(-)
hw/char/pl011.c +99 -6
@@ -169,6 +169,73 @@ static void pl011_set_read_trigger(PL011State *s) s->read_trigger =1 ; } +static gboolean pl011_xmit (GIOChannel *chan,GIOCondition cond,void *opaque) +{ +PL011State *s = (PL011State *)opaque; +int ret; + +/* Drain FIFO if there is no backend */ +if (!qemu_chr_fe_backend_connected (&s->chr)) { + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; +return FALSE; + } + +/* Nothing to do */ +if (!s->write_count) { +return FALSE; + } + + ret =qemu_chr_fe_write (&s->chr, s->write_fifo, s->write_count); +if (ret >0 ) { + s->write_count -= ret; +memmove (s->write_fifo, s->write_fifo + ret, s->write_count); + s->flags &= ~PL011_FLAG_TXFF ; +if (!s->write_count) { + s->flags |=PL011_FLAG_TXFE ; + } + } + +if (s->write_count) { + s->watch_tag =qemu_chr_fe_add_watch (&s->chr,G_IO_OUT |G_IO_HUP , + pl011_xmit, s); +if (!s->watch_tag) { + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; +return FALSE; + } + } + + s->int_level |=PL011_INT_TX ; +pl011_update (s); +return FALSE; +} + +static void pl011_write_fifo (void *opaque,const unsigned char *buf,int size) +{ +PL011State *s = (PL011State *)opaque; +int depth = (s->lcr &0x10 ) ?16 :1 ; + +if (size >= (depth - s->write_count)) { + size = depth - s->write_count; + } + +if (size >0 ) { +memcpy (s->write_fifo + s->write_count, buf, size); + s->write_count += size; +if (s->write_count >= depth) { + s->flags |=PL011_FLAG_TXFF ; + } + s->flags &= ~PL011_FLAG_TXFE ; + } + +if (!s->watch_tag) { +pl011_xmit (NULL ,G_IO_OUT , s); + } +} +static void pl011_write (void *opaque,hwaddr offset,uint64_t value,unsigned size) {
@@ -179,13 +246,8 @@ static void pl011_write(void *opaque, hwaddr offset,switch (offset >>2 ) {case 0 :/* UARTDR */ -/* ??? Check if transmitter is enabled. */ ch = value; -/* XXX this blocks entire thread. Rewrite to use -* qemu_chr_fe_write and background I/O callbacks */ -qemu_chr_fe_write_all (&s->chr, &ch,1 ); - s->int_level |=PL011_INT_TX ; -pl011_update (s); +pl011_write_fifo (opaque, &ch,1 );break ;case 1 :/* UARTRSR/UARTECR */ s->rsr =0 ;
@@ -207,7 +269,16 @@ static void pl011_write(void *opaque, hwaddr offset,if ((s->lcr ^ value) &0x10 ) { s->read_count =0 ; s->read_pos =0 ; + +if (s->watch_tag) { +g_source_remove (s->watch_tag); + s->watch_tag =0 ; + } + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; } + s->lcr = value;pl011_set_read_trigger (s);break ;
@@ -292,6 +363,24 @@ static const MemoryRegionOps pl011_ops = { .endianness = DEVICE_NATIVE_ENDIAN, }; +static bool pl011_write_fifo_needed (void *opaque) +{ +PL011State *s = (PL011State *)opaque; +return s->write_count >0 ; +} + +static const VMStateDescription vmstate_pl011_write_fifo = { + .name ="pl011/write_fifo" , + .version_id =1 , + .minimum_version_id =1 , + .needed = pl011_write_fifo_needed, + .fields = (VMStateField []) { +VMSTATE_INT32 (write_count, PL011State), +VMSTATE_UINT8_ARRAY (write_fifo, PL011State,16 ), +VMSTATE_END_OF_LIST () + } +}; +static const VMStateDescription vmstate_pl011 = { .name ="pl011" , .version_id =2 ,
@@ -314,6 +403,10 @@ static const VMStateDescription vmstate_pl011 = { VMSTATE_INT32(read_count, PL011State), VMSTATE_INT32(read_trigger, PL011State),VMSTATE_END_OF_LIST () + }, + .subsections = (const VMStateDescription * []) { + &vmstate_pl011_write_fifo, +NULL } };
include/hw/char/pl011.h +3 -0
@@ -38,6 +38,7 @@ typedef struct PL011State {uint32_t int_enabled;uint32_t int_level;uint32_t read_fifo[16 ]; +uint8_t write_fifo[16 ];uint32_t ilpr;uint32_t ibrd;uint32_t fbrd;
@@ -45,6 +46,8 @@ typedef struct PL011State {int read_pos;int read_count;int read_trigger; +int write_count; +guint watch_tag;CharBackend chr;qemu_irq irq[6 ];const unsigned char *id;
Signature · 1 line
2.23.0
Quoted 10 lines · Gavin Shan
The depth of TxFIFO can be 1 or 16 depending on LCR[4]. The TxFIFO is disabled when its depth is 1. It's nice to have TxFIFO enabled if possible because more characters can be piled and transmitted at once, which would have less overhead. Besides, we can be blocked because of
qemu_chr_fe_write_all(), which isn't nice.This enables TxFIFO if possible. On ther other hand, the asynchronous transmission is enabled if needed, as we did in
hw/char/cadence_uart.cSigned-off-by Gavin Shan <[email protected]>
Quoted 9 lines
---
v2: Put write_{count,fifo} into migration subsection
Don't start async IO handle if it has been started, to avoid race Update with PL011_FLAG_{TXFF,TXFE} on changingwrite_count--- hw/char/pl011.c | 105 +++++++++++++++++++++++++++++++++++++--- include/hw/char/pl011.h | 3 ++ 2 files changed, 102 insertions(+), 6 deletions(-)
ping? :)
Quoted 168 lines
hw/char/pl011.c +99
-6@@ -169,6 +169,73 @@ static void pl011_set_read_trigger(PL011State *s) s->read_trigger =1 ; } +static gboolean pl011_xmit (GIOChannel *chan,GIOCondition cond,void *opaque) +{ +PL011State *s = (PL011State *)opaque; +int ret; + +/* Drain FIFO if there is no backend */ +if (!qemu_chr_fe_backend_connected (&s->chr)) { + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; +return FALSE; + } + +/* Nothing to do */ +if (!s->write_count) { +return FALSE; + } + + ret =qemu_chr_fe_write (&s->chr, s->write_fifo, s->write_count); +if (ret >0 ) { + s->write_count -= ret; +memmove (s->write_fifo, s->write_fifo + ret, s->write_count); + s->flags &= ~PL011_FLAG_TXFF ; +if (!s->write_count) { + s->flags |=PL011_FLAG_TXFE ; + } + } + +if (s->write_count) { + s->watch_tag =qemu_chr_fe_add_watch (&s->chr,G_IO_OUT |G_IO_HUP , + pl011_xmit, s); +if (!s->watch_tag) { + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; +return FALSE; + } + } + + s->int_level |=PL011_INT_TX ; +pl011_update (s); +return FALSE; +} + +static void pl011_write_fifo (void *opaque,const unsigned char *buf,int size) +{ +PL011State *s = (PL011State *)opaque; +int depth = (s->lcr &0x10 ) ?16 :1 ; + +if (size >= (depth - s->write_count)) { + size = depth - s->write_count; + } + +if (size >0 ) { +memcpy (s->write_fifo + s->write_count, buf, size); + s->write_count += size; +if (s->write_count >= depth) { + s->flags |=PL011_FLAG_TXFF ; + } + s->flags &= ~PL011_FLAG_TXFE ; + } + +if (!s->watch_tag) { +pl011_xmit (NULL ,G_IO_OUT , s); + } +} +static void pl011_write (void *opaque,hwaddr offset,uint64_t value,unsigned size) {@@ -179,13 +246,8 @@ static void pl011_write(void *opaque, hwaddr offset,switch (offset >>2 ) {case 0 :/* UARTDR */ -/* ??? Check if transmitter is enabled. */ ch = value; -/* XXX this blocks entire thread. Rewrite to use -* qemu_chr_fe_write and background I/O callbacks */ -qemu_chr_fe_write_all (&s->chr, &ch,1 ); - s->int_level |=PL011_INT_TX ; -pl011_update (s); +pl011_write_fifo (opaque, &ch,1 );break ;case 1 :/* UARTRSR/UARTECR */ s->rsr =0 ;@@ -207,7 +269,16 @@ static void pl011_write(void *opaque, hwaddr offset,if ((s->lcr ^ value) &0x10 ) { s->read_count =0 ; s->read_pos =0 ; + +if (s->watch_tag) { +g_source_remove (s->watch_tag); + s->watch_tag =0 ; + } + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; } + s->lcr = value;pl011_set_read_trigger (s);break ;@@ -292,6 +363,24 @@ static const MemoryRegionOps pl011_ops = { .endianness = DEVICE_NATIVE_ENDIAN, }; +static bool pl011_write_fifo_needed (void *opaque) +{ +PL011State *s = (PL011State *)opaque; +return s->write_count >0 ; +} + +static const VMStateDescription vmstate_pl011_write_fifo = { + .name ="pl011/write_fifo" , + .version_id =1 , + .minimum_version_id =1 , + .needed = pl011_write_fifo_needed, + .fields = (VMStateField []) { +VMSTATE_INT32 (write_count, PL011State), +VMSTATE_UINT8_ARRAY (write_fifo, PL011State,16 ), +VMSTATE_END_OF_LIST () + } +}; +static const VMStateDescription vmstate_pl011 = { .name ="pl011" , .version_id =2 ,@@ -314,6 +403,10 @@ static const VMStateDescription vmstate_pl011 = { VMSTATE_INT32(read_count, PL011State), VMSTATE_INT32(read_trigger, PL011State),VMSTATE_END_OF_LIST () + }, + .subsections = (const VMStateDescription * []) { + &vmstate_pl011_write_fifo, +NULL } };include/hw/char/pl011.h +3
-0@@ -38,6 +38,7 @@ typedef struct PL011State {uint32_t int_enabled;uint32_t int_level;uint32_t read_fifo[16 ]; +uint8_t write_fifo[16 ];uint32_t ilpr;uint32_t ibrd;uint32_t fbrd;@@ -45,6 +46,8 @@ typedef struct PL011State {int read_pos;int read_count;int read_trigger; +int write_count; +guint watch_tag;CharBackend chr;qemu_irq irq[6 ];const unsigned char *id;
Hi
Quoted 25 lines · Gavin Shan
The depth of TxFIFO can be 1 or 16 depending on LCR[4]. The TxFIFO is disabled when its depth is 1. It's nice to have TxFIFO enabled if possible because more characters can be piled and transmitted at once, which would have less overhead. Besides, we can be blocked because of
qemu_chr_fe_write_all(), which isn't nice.This enables TxFIFO if possible. On ther other hand, the asynchronous transmission is enabled if needed, as we did in
hw/char/cadence_uart.cSigned-off-by Gavin Shan <[email protected]>---
v2: Put write_{count,fifo} into migration subsection
Don't start async IO handle if it has been started, to avoid race Update with PL011_FLAG_{TXFF,TXFE} on changingwrite_count--- hw/char/pl011.c | 105 +++++++++++++++++++++++++++++++++++++--- include/hw/char/pl011.h | 3 ++ 2 files changed, 102 insertions(+), 6 deletions(-)hw/char/pl011.c +0
-0
hw/char/pl011.c static void pl011_set_read_trigger(PL011State *s) · line 174
Quoted 6 lines
hw/char/pl011.c +3
-0@@ -169,6 +169,73 @@ static void pl011_set_read_trigger(PL011State *s) s->read_trigger =1 ; } +static gboolean pl011_xmit (GIOChannel *chan,GIOCondition cond,void *opaque) +{ +PL011State *s = (PL011State *)opaque;
Useless casts, perhaps use PL011() instead?
hw/char/pl011.c static void pl011_set_read_trigger(PL011State *s) · line 182
Quoted 8 lines
hw/char/pl011.c +8
-0+int ret; + +/* Drain FIFO if there is no backend */ +if (!qemu_chr_fe_backend_connected (&s->chr)) { + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; +return FALSE;
Perhaps use G_SOURCE_REMOVE ?
Quoted 29 lines
hw/char/pl011.c +29
-0+ } + +/* Nothing to do */ +if (!s->write_count) { +return FALSE; + } + + ret =qemu_chr_fe_write (&s->chr, s->write_fifo, s->write_count); +if (ret >0 ) { + s->write_count -= ret; +memmove (s->write_fifo, s->write_fifo + ret, s->write_count); + s->flags &= ~PL011_FLAG_TXFF ; +if (!s->write_count) { + s->flags |=PL011_FLAG_TXFE ; + } + } + +if (s->write_count) { + s->watch_tag =qemu_chr_fe_add_watch (&s->chr,G_IO_OUT |G_IO_HUP , + pl011_xmit, s); +if (!s->watch_tag) { + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; +return FALSE; + } + } + + s->int_level |=PL011_INT_TX ;
hw/char/pl011.c static void pl011_set_read_trigger(PL011State *s) · line 221
Quoted 10 lines
hw/char/pl011.c +10
-0+pl011_update (s); +return FALSE; +} + +static void pl011_write_fifo (void *opaque,const unsigned char *buf,int size) +{ +PL011State *s = (PL011State *)opaque; +int depth = (s->lcr &0x10 ) ?16 :1 ; + +if (size >= (depth - s->write_count)) {
parenthesis could be dropped
hw/char/pl011.c static void pl011_set_read_trigger(PL011State *s) · line 224
Quoted 3 lines
hw/char/pl011.c +3
-0+ size = depth - s->write_count; + } +
Why make a function that accepts size != 1 (and may silently drop data), when the only caller is pl011_write_fifo(opaque, &ch, 1); ?
hw/char/pl011.c static void pl011_set_read_trigger(PL011State *s) · line 225
Quoted 1 line
hw/char/pl011.c +1
-0+if (size >0 ) {
I don't think other cases are supposed to happen.
Quoted 106 lines
hw/char/pl011.c +45
-6+memcpy (s->write_fifo + s->write_count, buf, size); + s->write_count += size; +if (s->write_count >= depth) { + s->flags |=PL011_FLAG_TXFF ; + } + s->flags &= ~PL011_FLAG_TXFE ; + } + +if (!s->watch_tag) { +pl011_xmit (NULL ,G_IO_OUT , s); + } +} +static void pl011_write (void *opaque,hwaddr offset,uint64_t value,unsigned size) {@@ -179,13 +246,8 @@ static void pl011_write(void *opaque, hwaddr offset,switch (offset >>2 ) {case 0 :/* UARTDR */ -/* ??? Check if transmitter is enabled. */ ch = value; -/* XXX this blocks entire thread. Rewrite to use -* qemu_chr_fe_write and background I/O callbacks */ -qemu_chr_fe_write_all (&s->chr, &ch,1 ); - s->int_level |=PL011_INT_TX ; -pl011_update (s); +pl011_write_fifo (opaque, &ch,1 );break ;case 1 :/* UARTRSR/UARTECR */ s->rsr =0 ;@@ -207,7 +269,16 @@ static void pl011_write(void *opaque, hwaddr offset,if ((s->lcr ^ value) &0x10 ) { s->read_count =0 ; s->read_pos =0 ; + +if (s->watch_tag) { +g_source_remove (s->watch_tag); + s->watch_tag =0 ; + } + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; } + s->lcr = value;pl011_set_read_trigger (s);break ;@@ -292,6 +363,24 @@ static const MemoryRegionOps pl011_ops = { .endianness = DEVICE_NATIVE_ENDIAN, }; +static bool pl011_write_fifo_needed (void *opaque) +{ +PL011State *s = (PL011State *)opaque; +return s->write_count >0 ; +} + +static const VMStateDescription vmstate_pl011_write_fifo = { + .name ="pl011/write_fifo" , + .version_id =1 , + .minimum_version_id =1 , + .needed = pl011_write_fifo_needed, + .fields = (VMStateField []) { +VMSTATE_INT32 (write_count, PL011State), +VMSTATE_UINT8_ARRAY (write_fifo, PL011State,16 ), +VMSTATE_END_OF_LIST () + } +}; +static const VMStateDescription vmstate_pl011 = { .name ="pl011" , .version_id =2 ,@@ -314,6 +403,10 @@ static const VMStateDescription vmstate_pl011 = { VMSTATE_INT32(read_count, PL011State), VMSTATE_INT32(read_trigger, PL011State),VMSTATE_END_OF_LIST () + }, + .subsections = (const VMStateDescription * []) { + &vmstate_pl011_write_fifo, +NULL } };include/hw/char/pl011.h +3
-1@@ -38,6 +38,7 @@ typedef struct PL011State {uint32_t int_enabled;uint32_t int_level;uint32_t read_fifo[16 ]; +uint8_t write_fifo[16 ];uint32_t ilpr;uint32_t ibrd;uint32_t fbrd;@@ -45,6 +46,8 @@ typedef struct PL011State {int read_pos;int read_count;int read_trigger; +int write_count; +guint watch_tag;CharBackend chr;qemu_irq irq[6 ];const unsigned char *id; --
Quoted 3 lines
2.23.0
Looks ok otherwise
Signature · 1 line
Marc-André Lureau
Quoted 30 lines · Marc-André Lureau
Quoted 28 lines · Gavin Shan
The depth of TxFIFO can be 1 or 16 depending on LCR[4]. The TxFIFO is disabled when its depth is 1. It's nice to have TxFIFO enabled if possible because more characters can be piled and transmitted at once, which would have less overhead. Besides, we can be blocked because of
qemu_chr_fe_write_all(), which isn't nice.This enables TxFIFO if possible. On ther other hand, the asynchronous transmission is enabled if needed, as we did in
hw/char/cadence_uart.cSigned-off-by Gavin Shan <[email protected]>---
v2: Put write_{count,fifo} into migration subsection
Don't start async IO handle if it has been started, to avoid race Update with PL011_FLAG_{TXFF,TXFE} on changingwrite_count--- hw/char/pl011.c | 105 +++++++++++++++++++++++++++++++++++++--- include/hw/char/pl011.h | 3 ++ 2 files changed, 102 insertions(+), 6 deletions(-)hw/char/pl011.c +0
-0@@ -169,6 +169,73 @@ static void pl011_set_read_trigger(PL011State *s) s->read_trigger =1 ; }
Quoted 6 lines
hw/char/pl011.c static void pl011_set_read_trigger(PL011State *s) · line 174
Quoted 3 lines
hw/char/pl011.c +3
-0+static gboolean pl011_xmit (GIOChannel *chan,GIOCondition cond,void *opaque) +{ +PL011State *s = (PL011State *)opaque;Useless casts, perhaps use
PL011()instead?
Yes, PL011() makes the code a bit more safer. It will be used in next respin.
Quoted 11 lines
hw/char/pl011.c static void pl011_set_read_trigger(PL011State *s) · line 182
Quoted 8 lines
hw/char/pl011.c +8
-0+int ret; + +/* Drain FIFO if there is no backend */ +if (!qemu_chr_fe_backend_connected (&s->chr)) { + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; +return FALSE;Perhaps use
G_SOURCE_REMOVE?
Yes, it's more precise even it's equal to false. It will be used in next respin.
Quoted 33 lines
Quoted 33 lines
hw/char/pl011.c +33
-0+ } + +/* Nothing to do */ +if (!s->write_count) { +return FALSE; + } + + ret =qemu_chr_fe_write (&s->chr, s->write_fifo, s->write_count); +if (ret >0 ) { + s->write_count -= ret; +memmove (s->write_fifo, s->write_fifo + ret, s->write_count); + s->flags &= ~PL011_FLAG_TXFF ; +if (!s->write_count) { + s->flags |=PL011_FLAG_TXFE ; + } + } + +if (s->write_count) { + s->watch_tag =qemu_chr_fe_add_watch (&s->chr,G_IO_OUT |G_IO_HUP , + pl011_xmit, s); +if (!s->watch_tag) { + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; +return FALSE; + } + } + + s->int_level |=PL011_INT_TX ; +pl011_update (s); +return FALSE; +} +
Quoted 9 lines
hw/char/pl011.c static void pl011_set_read_trigger(PL011State *s) · line 221
Quoted 6 lines
hw/char/pl011.c +6
-0+static void pl011_write_fifo (void *opaque,const unsigned char *buf,int size) +{ +PL011State *s = (PL011State *)opaque; +int depth = (s->lcr &0x10 ) ?16 :1 ; + +if (size >= (depth - s->write_count)) {parenthesis could be dropped
It's really personal taste, but it will be dropped in next respin :)
Quoted 11 lines
hw/char/pl011.c static void pl011_set_read_trigger(PL011State *s) · line 224
Quoted 3 lines
hw/char/pl011.c +3
-0+ size = depth - s->write_count; + } +Why make a function that accepts size != 1 (and may silently drop data), when the only caller is
pl011_write_fifo(opaque, &ch, 1); ?hw/char/pl011.c static void pl011_set_read_trigger(PL011State *s) · line 225
Quoted 1 line
hw/char/pl011.c +1
-0+if (size >0 ) {I don't think other cases are supposed to happen.
The function will be reused when loopback mode is enabled in future. The received characters could be sent in batch mode in loopback mode. So we have variable size here. The caller won't lose data by checking the amount of characters are sent successfully. Also, the check on @size makes the code looks complete and lets keep it.
Quoted 103 lines
Quoted 103 lines
hw/char/pl011.c +45
-6+memcpy (s->write_fifo + s->write_count, buf, size); + s->write_count += size; +if (s->write_count >= depth) { + s->flags |=PL011_FLAG_TXFF ; + } + s->flags &= ~PL011_FLAG_TXFE ; + } + +if (!s->watch_tag) { +pl011_xmit (NULL ,G_IO_OUT , s); + } +} +static void pl011_write (void *opaque,hwaddr offset,uint64_t value,unsigned size) {@@ -179,13 +246,8 @@ static void pl011_write(void *opaque, hwaddr offset,switch (offset >>2 ) {case 0 :/* UARTDR */ -/* ??? Check if transmitter is enabled. */ ch = value; -/* XXX this blocks entire thread. Rewrite to use -* qemu_chr_fe_write and background I/O callbacks */ -qemu_chr_fe_write_all (&s->chr, &ch,1 ); - s->int_level |=PL011_INT_TX ; -pl011_update (s); +pl011_write_fifo (opaque, &ch,1 );break ;case 1 :/* UARTRSR/UARTECR */ s->rsr =0 ;@@ -207,7 +269,16 @@ static void pl011_write(void *opaque, hwaddr offset,if ((s->lcr ^ value) &0x10 ) { s->read_count =0 ; s->read_pos =0 ; + +if (s->watch_tag) { +g_source_remove (s->watch_tag); + s->watch_tag =0 ; + } + s->write_count =0 ; + s->flags &= ~PL011_FLAG_TXFF ; + s->flags |=PL011_FLAG_TXFE ; } + s->lcr = value;pl011_set_read_trigger (s);break ;@@ -292,6 +363,24 @@ static const MemoryRegionOps pl011_ops = { .endianness = DEVICE_NATIVE_ENDIAN, }; +static bool pl011_write_fifo_needed (void *opaque) +{ +PL011State *s = (PL011State *)opaque; +return s->write_count >0 ; +} + +static const VMStateDescription vmstate_pl011_write_fifo = { + .name ="pl011/write_fifo" , + .version_id =1 , + .minimum_version_id =1 , + .needed = pl011_write_fifo_needed, + .fields = (VMStateField []) { +VMSTATE_INT32 (write_count, PL011State), +VMSTATE_UINT8_ARRAY (write_fifo, PL011State,16 ), +VMSTATE_END_OF_LIST () + } +}; +static const VMStateDescription vmstate_pl011 = { .name ="pl011" , .version_id =2 ,@@ -314,6 +403,10 @@ static const VMStateDescription vmstate_pl011 = { VMSTATE_INT32(read_count, PL011State), VMSTATE_INT32(read_trigger, PL011State),VMSTATE_END_OF_LIST () + }, + .subsections = (const VMStateDescription * []) { + &vmstate_pl011_write_fifo, +NULL } };include/hw/char/pl011.h +3
-0@@ -38,6 +38,7 @@ typedef struct PL011State {uint32_t int_enabled;uint32_t int_level;uint32_t read_fifo[16 ]; +uint8_t write_fifo[16 ];uint32_t ilpr;uint32_t ibrd;uint32_t fbrd;@@ -45,6 +46,8 @@ typedef struct PL011State {int read_pos;int read_count;int read_trigger; +int write_count; +guint watch_tag;CharBackend chr;
Quoted 9 lines
Quoted 6 lines
include/hw/char/pl011.h +0
-1qemu_irq irq[6 ];const unsigned char *id; --2.23.0
Looks ok otherwise
Thanks for your comments. I will post v3 after you think it's fine to change the code as above :)
Thanks,
Gavin