Message ID | 20231020170009.86870-2-philmd@linaro.org |
---|---|
State | New |
Headers | show |
Series | stm32f2xx_usart: implement TX interrupts | expand |
On 10/20/23 10:00, Philippe Mathieu-Daudé wrote: > From: Hans-Erik Floryd <hans-erik.floryd@rt-labs.com> > > Signed-off-by: Hans-Erik Floryd <hans-erik.floryd@rt-labs.com> > [PMD: Split from bigger patch] > Signed-off-by: Philippe Mathieu-Daudé <philmd@linaro.org> > --- > hw/char/stm32f2xx_usart.c | 28 ++++++++++++++++------------ > 1 file changed, 16 insertions(+), 12 deletions(-) Reviewed-by: Richard Henderson <richard.henderson@linaro.org> r~
On Sat, Oct 21, 2023 at 4:14 AM Philippe Mathieu-Daudé <philmd@linaro.org> wrote: > > From: Hans-Erik Floryd <hans-erik.floryd@rt-labs.com> > > Signed-off-by: Hans-Erik Floryd <hans-erik.floryd@rt-labs.com> > [PMD: Split from bigger patch] > Signed-off-by: Philippe Mathieu-Daudé <philmd@linaro.org> Reviewed-by: Alistair Francis <alistair.francis@wdc.com> Alistair > --- > hw/char/stm32f2xx_usart.c | 28 ++++++++++++++++------------ > 1 file changed, 16 insertions(+), 12 deletions(-) > > diff --git a/hw/char/stm32f2xx_usart.c b/hw/char/stm32f2xx_usart.c > index fde67f4f03..519d3461a3 100644 > --- a/hw/char/stm32f2xx_usart.c > +++ b/hw/char/stm32f2xx_usart.c > @@ -53,6 +53,17 @@ static int stm32f2xx_usart_can_receive(void *opaque) > return 0; > } > > +static void stm32f2xx_update_irq(STM32F2XXUsartState *s) > +{ > + uint32_t mask = s->usart_sr & s->usart_cr1; > + > + if (mask & (USART_SR_TXE | USART_SR_TC | USART_SR_RXNE)) { > + qemu_set_irq(s->irq, 1); > + } else { > + qemu_set_irq(s->irq, 0); > + } > +} > + > static void stm32f2xx_usart_receive(void *opaque, const uint8_t *buf, int size) > { > STM32F2XXUsartState *s = opaque; > @@ -66,9 +77,7 @@ static void stm32f2xx_usart_receive(void *opaque, const uint8_t *buf, int size) > s->usart_dr = *buf; > s->usart_sr |= USART_SR_RXNE; > > - if (s->usart_cr1 & USART_CR1_RXNEIE) { > - qemu_set_irq(s->irq, 1); > - } > + stm32f2xx_update_irq(s); > > DB_PRINT("Receiving: %c\n", s->usart_dr); > } > @@ -85,7 +94,7 @@ static void stm32f2xx_usart_reset(DeviceState *dev) > s->usart_cr3 = 0x00000000; > s->usart_gtpr = 0x00000000; > > - qemu_set_irq(s->irq, 0); > + stm32f2xx_update_irq(s); > } > > static uint64_t stm32f2xx_usart_read(void *opaque, hwaddr addr, > @@ -106,7 +115,7 @@ static uint64_t stm32f2xx_usart_read(void *opaque, hwaddr addr, > retvalue = s->usart_dr & 0x3FF; > s->usart_sr &= ~USART_SR_RXNE; > qemu_chr_fe_accept_input(&s->chr); > - qemu_set_irq(s->irq, 0); > + stm32f2xx_update_irq(s); > return retvalue; > case USART_BRR: > return s->usart_brr; > @@ -145,9 +154,7 @@ static void stm32f2xx_usart_write(void *opaque, hwaddr addr, > } else { > s->usart_sr &= value; > } > - if (!(s->usart_sr & USART_SR_RXNE)) { > - qemu_set_irq(s->irq, 0); > - } > + stm32f2xx_update_irq(s); > return; > case USART_DR: > if (value < 0xF000) { > @@ -168,10 +175,7 @@ static void stm32f2xx_usart_write(void *opaque, hwaddr addr, > return; > case USART_CR1: > s->usart_cr1 = value; > - if (s->usart_cr1 & USART_CR1_RXNEIE && > - s->usart_sr & USART_SR_RXNE) { > - qemu_set_irq(s->irq, 1); > - } > + stm32f2xx_update_irq(s); > return; > case USART_CR2: > s->usart_cr2 = value; > -- > 2.41.0 > >
diff --git a/hw/char/stm32f2xx_usart.c b/hw/char/stm32f2xx_usart.c index fde67f4f03..519d3461a3 100644 --- a/hw/char/stm32f2xx_usart.c +++ b/hw/char/stm32f2xx_usart.c @@ -53,6 +53,17 @@ static int stm32f2xx_usart_can_receive(void *opaque) return 0; } +static void stm32f2xx_update_irq(STM32F2XXUsartState *s) +{ + uint32_t mask = s->usart_sr & s->usart_cr1; + + if (mask & (USART_SR_TXE | USART_SR_TC | USART_SR_RXNE)) { + qemu_set_irq(s->irq, 1); + } else { + qemu_set_irq(s->irq, 0); + } +} + static void stm32f2xx_usart_receive(void *opaque, const uint8_t *buf, int size) { STM32F2XXUsartState *s = opaque; @@ -66,9 +77,7 @@ static void stm32f2xx_usart_receive(void *opaque, const uint8_t *buf, int size) s->usart_dr = *buf; s->usart_sr |= USART_SR_RXNE; - if (s->usart_cr1 & USART_CR1_RXNEIE) { - qemu_set_irq(s->irq, 1); - } + stm32f2xx_update_irq(s); DB_PRINT("Receiving: %c\n", s->usart_dr); } @@ -85,7 +94,7 @@ static void stm32f2xx_usart_reset(DeviceState *dev) s->usart_cr3 = 0x00000000; s->usart_gtpr = 0x00000000; - qemu_set_irq(s->irq, 0); + stm32f2xx_update_irq(s); } static uint64_t stm32f2xx_usart_read(void *opaque, hwaddr addr, @@ -106,7 +115,7 @@ static uint64_t stm32f2xx_usart_read(void *opaque, hwaddr addr, retvalue = s->usart_dr & 0x3FF; s->usart_sr &= ~USART_SR_RXNE; qemu_chr_fe_accept_input(&s->chr); - qemu_set_irq(s->irq, 0); + stm32f2xx_update_irq(s); return retvalue; case USART_BRR: return s->usart_brr; @@ -145,9 +154,7 @@ static void stm32f2xx_usart_write(void *opaque, hwaddr addr, } else { s->usart_sr &= value; } - if (!(s->usart_sr & USART_SR_RXNE)) { - qemu_set_irq(s->irq, 0); - } + stm32f2xx_update_irq(s); return; case USART_DR: if (value < 0xF000) { @@ -168,10 +175,7 @@ static void stm32f2xx_usart_write(void *opaque, hwaddr addr, return; case USART_CR1: s->usart_cr1 = value; - if (s->usart_cr1 & USART_CR1_RXNEIE && - s->usart_sr & USART_SR_RXNE) { - qemu_set_irq(s->irq, 1); - } + stm32f2xx_update_irq(s); return; case USART_CR2: s->usart_cr2 = value;