| Message ID | 20220601102509.985650-39-yangxiaojuan@loongson.cn (mailing list archive) |
|---|---|
| State | New, archived |
| Headers | show |
| Series | Add LoongArch softmmu support | expand |
On 6/1/22 03:25, Xiaojuan Yang wrote: > This patch add ls7a rtc device support. > > Signed-off-by: Xiaojuan Yang <yangxiaojuan@loongson.cn> > Signed-off-by: Song Gao <gaosong@loongson.cn> > --- > MAINTAINERS | 1 + > hw/loongarch/Kconfig | 1 + > hw/loongarch/loongson3.c | 3 + > hw/rtc/Kconfig | 3 + > hw/rtc/ls7a_rtc.c | 528 +++++++++++++++++++++++++++++++++++++ > hw/rtc/meson.build | 1 + > include/hw/pci-host/ls7a.h | 4 + > 7 files changed, 541 insertions(+) > create mode 100644 hw/rtc/ls7a_rtc.c Reviewed-by: Richard Henderson <richard.henderson@linaro.org> r~ > > diff --git a/MAINTAINERS b/MAINTAINERS > index c22f95fb6a..9f4ee7978d 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -1137,6 +1137,7 @@ F: include/hw/loongarch/virt.h > F: include/hw/intc/loongarch_*.h > F: hw/intc/loongarch_*.c > F: include/hw/pci-host/ls7a.h > +F: hw/rtc/ls7a_rtc.c > > M68K Machines > ------------- > diff --git a/hw/loongarch/Kconfig b/hw/loongarch/Kconfig > index 8552ff4bee..35b6680772 100644 > --- a/hw/loongarch/Kconfig > +++ b/hw/loongarch/Kconfig > @@ -13,3 +13,4 @@ config LOONGARCH_VIRT > select LOONGARCH_PCH_PIC > select LOONGARCH_PCH_MSI > select LOONGARCH_EXTIOI > + select LS7A_RTC > diff --git a/hw/loongarch/loongson3.c b/hw/loongarch/loongson3.c > index 7bc17113dc..95984c9086 100644 > --- a/hw/loongarch/loongson3.c > +++ b/hw/loongarch/loongson3.c > @@ -97,6 +97,9 @@ static void loongarch_devices_init(DeviceState *pch_pic) > * Create some unimplemented devices to emulate this. > */ > create_unimplemented_device("pci-dma-cfg", 0x1001041c, 0x4); > + sysbus_create_simple("ls7a_rtc", LS7A_RTC_REG_BASE, > + qdev_get_gpio_in(pch_pic, > + LS7A_RTC_IRQ - PCH_PIC_IRQ_OFFSET)); > } > > static void loongarch_irq_init(LoongArchMachineState *lams) > diff --git a/hw/rtc/Kconfig b/hw/rtc/Kconfig > index 730c272bc5..d0d8dda084 100644 > --- a/hw/rtc/Kconfig > +++ b/hw/rtc/Kconfig > @@ -27,3 +27,6 @@ config SUN4V_RTC > > config GOLDFISH_RTC > bool > + > +config LS7A_RTC > + bool > diff --git a/hw/rtc/ls7a_rtc.c b/hw/rtc/ls7a_rtc.c > new file mode 100644 > index 0000000000..fe6710310f > --- /dev/null > +++ b/hw/rtc/ls7a_rtc.c > @@ -0,0 +1,528 @@ > +/* SPDX-License-Identifier: GPL-2.0-or-later */ > +/* > + * Loongarch LS7A Real Time Clock emulation > + * > + * Copyright (C) 2021 Loongson Technology Corporation Limited > + */ > + > +#include "qemu/osdep.h" > +#include "hw/sysbus.h" > +#include "hw/irq.h" > +#include "include/hw/register.h" > +#include "qemu/timer.h" > +#include "sysemu/sysemu.h" > +#include "qemu/cutils.h" > +#include "qemu/log.h" > +#include "migration/vmstate.h" > +#include "hw/misc/unimp.h" > +#include "sysemu/rtc.h" > +#include "hw/registerfields.h" > + > +#define SYS_TOYTRIM 0x20 > +#define SYS_TOYWRITE0 0x24 > +#define SYS_TOYWRITE1 0x28 > +#define SYS_TOYREAD0 0x2C > +#define SYS_TOYREAD1 0x30 > +#define SYS_TOYMATCH0 0x34 > +#define SYS_TOYMATCH1 0x38 > +#define SYS_TOYMATCH2 0x3C > +#define SYS_RTCCTRL 0x40 > +#define SYS_RTCTRIM 0x60 > +#define SYS_RTCWRTIE0 0x64 > +#define SYS_RTCREAD0 0x68 > +#define SYS_RTCMATCH0 0x6C > +#define SYS_RTCMATCH1 0x70 > +#define SYS_RTCMATCH2 0x74 > + > +#define LS7A_RTC_FREQ 32768 > +#define TIMER_NUMS 3 > +/* > + * Shift bits and filed mask > + */ > + > +FIELD(TOY, MON, 26, 6) > +FIELD(TOY, DAY, 21, 5) > +FIELD(TOY, HOUR, 16, 5) > +FIELD(TOY, MIN, 10, 6) > +FIELD(TOY, SEC, 4, 6) > +FIELD(TOY, MSEC, 0, 4) > + > +FIELD(TOY_MATCH, YEAR, 26, 6) > +FIELD(TOY_MATCH, MON, 22, 4) > +FIELD(TOY_MATCH, DAY, 17, 5) > +FIELD(TOY_MATCH, HOUR, 12, 5) > +FIELD(TOY_MATCH, MIN, 6, 6) > +FIELD(TOY_MATCH, SEC, 0, 6) > + > +FIELD(RTC_CTRL, RTCEN, 13, 1) > +FIELD(RTC_CTRL, TOYEN, 11, 1) > +FIELD(RTC_CTRL, EO, 8, 1) > + > +#define TYPE_LS7A_RTC "ls7a_rtc" > +OBJECT_DECLARE_SIMPLE_TYPE(LS7ARtcState, LS7A_RTC) > + > +struct LS7ARtcState { > + SysBusDevice parent_obj; > + > + MemoryRegion iomem; > + /* > + * Needed to preserve the tick_count across migration, even if the > + * absolute value of the rtc_clock is different on the source and > + * destination. > + */ > + int64_t offset_toy; > + int64_t offset_rtc; > + uint64_t save_toy_mon; > + uint64_t save_toy_year; > + uint64_t save_rtc; > + int64_t data; > + int tidx; > + uint32_t toymatch[3]; > + uint32_t toytrim; > + uint32_t cntrctl; > + uint32_t rtctrim; > + uint32_t rtccount; > + uint32_t rtcmatch[3]; > + QEMUTimer *toy_timer[TIMER_NUMS]; > + QEMUTimer *rtc_timer[TIMER_NUMS]; > + qemu_irq irq; > +}; > + > +/* switch nanoseconds time to rtc ticks */ > +static inline uint64_t ls7a_rtc_ticks(void) > +{ > + return qemu_clock_get_ns(rtc_clock) * LS7A_RTC_FREQ / NANOSECONDS_PER_SECOND; > +} > + > +/* switch rtc ticks to nanoseconds */ > +static inline uint64_t ticks_to_ns(uint64_t ticks) > +{ > + return ticks * NANOSECONDS_PER_SECOND / LS7A_RTC_FREQ; > +} > + > +static inline bool toy_enabled(LS7ARtcState *s) > +{ > + return FIELD_EX32(s->cntrctl, RTC_CTRL, TOYEN) && > + FIELD_EX32(s->cntrctl, RTC_CTRL, EO); > +} > + > +static inline bool rtc_enabled(LS7ARtcState *s) > +{ > + return FIELD_EX32(s->cntrctl, RTC_CTRL, RTCEN) && > + FIELD_EX32(s->cntrctl, RTC_CTRL, EO); > +} > + > +/* parse toy value to struct tm */ > +static inline void toy_val_to_time_mon(uint64_t toy_val, struct tm *tm) > +{ > + tm->tm_sec = FIELD_EX32(toy_val, TOY, SEC); > + tm->tm_min = FIELD_EX32(toy_val, TOY, MIN); > + tm->tm_hour = FIELD_EX32(toy_val, TOY, HOUR); > + tm->tm_mday = FIELD_EX32(toy_val, TOY, DAY); > + tm->tm_mon = FIELD_EX32(toy_val, TOY, MON) - 1; > +} > + > +static inline void toy_val_to_time_year(uint64_t toy_year, struct tm *tm) > +{ > + tm->tm_year = toy_year; > +} > + > +/* parse struct tm to toy value */ > +static inline uint64_t toy_time_to_val_mon(struct tm tm) > +{ > + uint64_t val = 0; > + > + val = FIELD_DP32(val, TOY, MON, tm.tm_mon + 1); > + val = FIELD_DP32(val, TOY, DAY, tm.tm_mday); > + val = FIELD_DP32(val, TOY, HOUR, tm.tm_hour); > + val = FIELD_DP32(val, TOY, MIN, tm.tm_min); > + val = FIELD_DP32(val, TOY, SEC, tm.tm_sec); > + return val; > +} > + > +static inline uint64_t toy_time_to_val_year(struct tm tm) > +{ > + uint64_t year; > + > + year = tm.tm_year; > + return year; > +} > + > +static inline void toymatch_val_to_time(uint64_t val, struct tm *tm) > +{ > + tm->tm_sec = FIELD_EX32(val, TOY_MATCH, SEC); > + tm->tm_min = FIELD_EX32(val, TOY_MATCH, MIN); > + tm->tm_hour = FIELD_EX32(val, TOY_MATCH, HOUR); > + tm->tm_mday = FIELD_EX32(val, TOY_MATCH, DAY); > + tm->tm_mon = FIELD_EX32(val, TOY_MATCH, MON) - 1; > + tm->tm_year += (FIELD_EX32(val, TOY_MATCH, YEAR) - (tm->tm_year & 0x3f)); > +} > + > +static void toymatch_write(LS7ARtcState *s, struct tm *tm, uint64_t val, int num) > +{ > + int64_t now, expire_time; > + > + /* it do not support write when toy disabled */ > + if (toy_enabled(s)) { > + s->toymatch[num] = val; > + /* caculate expire time */ > + now = qemu_clock_get_ms(rtc_clock); > + toymatch_val_to_time(val, tm); > + expire_time = now + (qemu_timedate_diff(tm) - s->offset_toy) * 1000; > + timer_mod(s->toy_timer[num], expire_time); > + } > +} > + > +static void rtcmatch_write(LS7ARtcState *s, uint64_t val, int num) > +{ > + uint64_t expire_ns; > + > + /* it do not support write when toy disabled */ > + if (rtc_enabled(s)) { > + s->rtcmatch[num] = val; > + /* caculate expire time */ > + expire_ns = ticks_to_ns(val) - ticks_to_ns(s->offset_rtc); > + timer_mod_ns(s->rtc_timer[num], expire_ns); > + } > +} > + > +static void ls7a_toy_stop(LS7ARtcState *s) > +{ > + int i; > + struct tm tm; > + /* > + * save time when disabled toy, > + * because toy time not add counters. > + */ > + qemu_get_timedate(&tm, s->offset_toy); > + s->save_toy_mon = toy_time_to_val_mon(tm); > + s->save_toy_year = toy_time_to_val_year(tm); > + > + /* delete timers, and when re-enabled, recaculate expire time */ > + for (i = 0; i < TIMER_NUMS; i++) { > + timer_del(s->toy_timer[i]); > + } > +} > + > +static void ls7a_rtc_stop(LS7ARtcState *s) > +{ > + int i; > + uint64_t time; > + > + /* save rtc time */ > + time = ls7a_rtc_ticks() + s->offset_rtc; > + s->save_rtc = time; > + > + /* delete timers, and when re-enabled, recaculate expire time */ > + for (i = 0; i < TIMER_NUMS; i++) { > + timer_del(s->rtc_timer[i]); > + } > +} > + > +static void ls7a_toy_start(LS7ARtcState *s) > +{ > + int i; > + uint64_t expire_time, now; > + struct tm tm; > + /* > + * need to recaculate toy offset > + * and expire time when enable it. > + */ > + toy_val_to_time_mon(s->save_toy_mon, &tm); > + toy_val_to_time_year(s->save_toy_year, &tm); > + > + s->offset_toy = qemu_timedate_diff(&tm); > + now = qemu_clock_get_ms(rtc_clock); > + > + /* recaculate expire time and enable timer */ > + for (i = 0; i < TIMER_NUMS; i++) { > + toymatch_val_to_time(s->toymatch[i], &tm); > + expire_time = now + (qemu_timedate_diff(&tm) - s->offset_toy) * 1000; > + timer_mod(s->toy_timer[i], expire_time); > + } > +} > + > +static void ls7a_rtc_start(LS7ARtcState *s) > +{ > + int i; > + uint64_t expire_time, now; > + > + /* > + * need to recaculate rtc offset > + * and expire time when enable it. > + */ > + now = ls7a_rtc_ticks(); > + s->offset_rtc = s->save_rtc - now; > + > + /* recaculate expire time and enable timer */ > + for (i = 0; i < TIMER_NUMS; i++) { > + expire_time = ticks_to_ns(s->rtcmatch[i]) - ticks_to_ns(s->offset_rtc); > + timer_mod_ns(s->rtc_timer[i], expire_time); > + } > +} > + > +static uint64_t ls7a_rtc_read(void *opaque, hwaddr addr, unsigned size) > +{ > + LS7ARtcState *s = LS7A_RTC(opaque); > + struct tm tm; > + int val = 0; > + > + switch (addr) { > + case SYS_TOYREAD0: > + /* if toy disabled, read save toy time */ > + if (toy_enabled(s)) { > + qemu_get_timedate(&tm, s->offset_toy); > + val = toy_time_to_val_mon(tm); > + } else { > + /* read save mon val */ > + val = s->save_toy_mon; > + } > + break; > + case SYS_TOYREAD1: > + /* if toy disabled, read save toy time */ > + if (toy_enabled(s)) { > + qemu_get_timedate(&tm, s->offset_toy); > + val = tm.tm_year; > + } else { > + /* read save year val */ > + val = s->save_toy_year; > + } > + break; > + case SYS_TOYMATCH0: > + val = s->toymatch[0]; > + break; > + case SYS_TOYMATCH1: > + val = s->toymatch[1]; > + break; > + case SYS_TOYMATCH2: > + val = s->toymatch[2]; > + break; > + case SYS_RTCCTRL: > + val = s->cntrctl; > + break; > + case SYS_RTCREAD0: > + /* if rtc disabled, read save rtc time */ > + if (rtc_enabled(s)) { > + val = ls7a_rtc_ticks() + s->offset_rtc; > + } else { > + val = s->save_rtc; > + } > + break; > + case SYS_RTCMATCH0: > + val = s->rtcmatch[0]; > + break; > + case SYS_RTCMATCH1: > + val = s->rtcmatch[1]; > + break; > + case SYS_RTCMATCH2: > + val = s->rtcmatch[2]; > + break; > + default: > + val = 0; > + break; > + } > + return val; > +} > + > +static void ls7a_rtc_write(void *opaque, hwaddr addr, > + uint64_t val, unsigned size) > +{ > + int old_toyen, old_rtcen, new_toyen, new_rtcen; > + LS7ARtcState *s = LS7A_RTC(opaque); > + struct tm tm; > + > + switch (addr) { > + case SYS_TOYWRITE0: > + /* it do not support write when toy disabled */ > + if (toy_enabled(s)) { > + qemu_get_timedate(&tm, s->offset_toy); > + tm.tm_sec = FIELD_EX32(val, TOY, SEC); > + tm.tm_min = FIELD_EX32(val, TOY, MIN); > + tm.tm_hour = FIELD_EX32(val, TOY, HOUR); > + tm.tm_mday = FIELD_EX32(val, TOY, DAY); > + tm.tm_mon = FIELD_EX32(val, TOY, MON) - 1; > + s->offset_toy = qemu_timedate_diff(&tm); > + } > + break; > + case SYS_TOYWRITE1: > + if (toy_enabled(s)) { > + qemu_get_timedate(&tm, s->offset_toy); > + tm.tm_year = val; > + s->offset_toy = qemu_timedate_diff(&tm); > + } > + break; > + case SYS_TOYMATCH0: > + toymatch_write(s, &tm, val, 0); > + break; > + case SYS_TOYMATCH1: > + toymatch_write(s, &tm, val, 1); > + break; > + case SYS_TOYMATCH2: > + toymatch_write(s, &tm, val, 2); > + break; > + case SYS_RTCCTRL: > + /* get old ctrl */ > + old_toyen = toy_enabled(s); > + old_rtcen = rtc_enabled(s); > + > + s->cntrctl = val; > + /* get new ctrl */ > + new_toyen = toy_enabled(s); > + new_rtcen = rtc_enabled(s); > + > + /* > + * we do not consider if EO changed, as it always set at most time. > + * toy or rtc enabled should start timer. otherwise, stop timer > + */ > + if (old_toyen != new_toyen) { > + if (new_toyen) { > + ls7a_toy_start(s); > + } else { > + ls7a_toy_stop(s); > + } > + } > + if (old_rtcen != new_rtcen) { > + if (new_rtcen) { > + ls7a_rtc_start(s); > + } else { > + ls7a_rtc_stop(s); > + } > + } > + break; > + case SYS_RTCWRTIE0: > + if (rtc_enabled(s)) { > + s->offset_rtc = val - ls7a_rtc_ticks(); > + } > + break; > + case SYS_RTCMATCH0: > + rtcmatch_write(s, val, 0); > + break; > + case SYS_RTCMATCH1: > + rtcmatch_write(s, val, 1); > + break; > + case SYS_RTCMATCH2: > + rtcmatch_write(s, val, 2); > + break; > + default: > + break; > + } > +} > + > +static const MemoryRegionOps ls7a_rtc_ops = { > + .read = ls7a_rtc_read, > + .write = ls7a_rtc_write, > + .endianness = DEVICE_LITTLE_ENDIAN, > + .valid = { > + .min_access_size = 4, > + .max_access_size = 4, > + }, > +}; > + > +static void toy_timer_cb(void *opaque) > +{ > + LS7ARtcState *s = opaque; > + > + if (toy_enabled(s)) { > + qemu_irq_pulse(s->irq); > + } > +} > + > +static void rtc_timer_cb(void *opaque) > +{ > + LS7ARtcState *s = opaque; > + > + if (rtc_enabled(s)) { > + qemu_irq_pulse(s->irq); > + } > +} > + > +static void ls7a_rtc_realize(DeviceState *dev, Error **errp) > +{ > + int i; > + SysBusDevice *sbd = SYS_BUS_DEVICE(dev); > + LS7ARtcState *d = LS7A_RTC(sbd); > + memory_region_init_io(&d->iomem, NULL, &ls7a_rtc_ops, > + (void *)d, "ls7a_rtc", 0x100); > + > + sysbus_init_irq(sbd, &d->irq); > + > + sysbus_init_mmio(sbd, &d->iomem); > + for (i = 0; i < TIMER_NUMS; i++) { > + d->toymatch[i] = 0; > + d->rtcmatch[i] = 0; > + d->toy_timer[i] = timer_new_ms(rtc_clock, toy_timer_cb, d); > + d->rtc_timer[i] = timer_new_ms(rtc_clock, rtc_timer_cb, d); > + } > + d->offset_toy = 0; > + d->offset_rtc = 0; > + d->save_toy_mon = 0; > + d->save_toy_year = 0; > + d->save_rtc = 0; > + > + create_unimplemented_device("mmio fallback 1", 0x10013ffc, 0x4); > +} > + > +static int ls7a_rtc_pre_save(void *opaque) > +{ > + LS7ARtcState *s = LS7A_RTC(opaque); > + > + ls7a_toy_stop(s); > + ls7a_rtc_stop(s); > + > + return 0; > +} > + > +static int ls7a_rtc_post_load(void *opaque, int version_id) > +{ > + LS7ARtcState *s = LS7A_RTC(opaque); > + if (toy_enabled(s)) { > + ls7a_toy_start(s); > + } > + > + if (rtc_enabled(s)) { > + ls7a_rtc_start(s); > + } > + > + return 0; > +} > + > +static const VMStateDescription vmstate_ls7a_rtc = { > + .name = "ls7a_rtc", > + .version_id = 1, > + .minimum_version_id = 1, > + .pre_save = ls7a_rtc_pre_save, > + .post_load = ls7a_rtc_post_load, > + .fields = (VMStateField[]) { > + VMSTATE_INT64(offset_toy, LS7ARtcState), > + VMSTATE_INT64(offset_rtc, LS7ARtcState), > + VMSTATE_UINT64(save_toy_mon, LS7ARtcState), > + VMSTATE_UINT64(save_toy_year, LS7ARtcState), > + VMSTATE_UINT64(save_rtc, LS7ARtcState), > + VMSTATE_UINT32_ARRAY(toymatch, LS7ARtcState, TIMER_NUMS), > + VMSTATE_UINT32_ARRAY(rtcmatch, LS7ARtcState, TIMER_NUMS), > + VMSTATE_UINT32(cntrctl, LS7ARtcState), > + VMSTATE_END_OF_LIST() > + } > +}; > + > +static void ls7a_rtc_class_init(ObjectClass *klass, void *data) > +{ > + DeviceClass *dc = DEVICE_CLASS(klass); > + dc->vmsd = &vmstate_ls7a_rtc; > + dc->realize = ls7a_rtc_realize; > + dc->desc = "ls7a rtc"; > +} > + > +static const TypeInfo ls7a_rtc_info = { > + .name = TYPE_LS7A_RTC, > + .parent = TYPE_SYS_BUS_DEVICE, > + .instance_size = sizeof(LS7ARtcState), > + .class_init = ls7a_rtc_class_init, > +}; > + > +static void ls7a_rtc_register_types(void) > +{ > + type_register_static(&ls7a_rtc_info); > +} > + > +type_init(ls7a_rtc_register_types) > diff --git a/hw/rtc/meson.build b/hw/rtc/meson.build > index 7cecdee5dd..dc33973384 100644 > --- a/hw/rtc/meson.build > +++ b/hw/rtc/meson.build > @@ -11,6 +11,7 @@ softmmu_ss.add(when: 'CONFIG_EXYNOS4', if_true: files('exynos4210_rtc.c')) > softmmu_ss.add(when: 'CONFIG_SUN4V_RTC', if_true: files('sun4v-rtc.c')) > softmmu_ss.add(when: 'CONFIG_ASPEED_SOC', if_true: files('aspeed_rtc.c')) > softmmu_ss.add(when: 'CONFIG_GOLDFISH_RTC', if_true: files('goldfish_rtc.c')) > +softmmu_ss.add(when: 'CONFIG_LS7A_RTC', if_true: files('ls7a_rtc.c')) > softmmu_ss.add(when: 'CONFIG_ALLWINNER_H3', if_true: files('allwinner-rtc.c')) > > specific_ss.add(when: 'CONFIG_MC146818RTC', if_true: files('mc146818rtc.c')) > diff --git a/include/hw/pci-host/ls7a.h b/include/hw/pci-host/ls7a.h > index 5c653527f0..08c5f78be2 100644 > --- a/include/hw/pci-host/ls7a.h > +++ b/include/hw/pci-host/ls7a.h > @@ -37,4 +37,8 @@ > #define LS7A_PCI_IRQS 48 > #define LS7A_UART_IRQ (PCH_PIC_IRQ_OFFSET + 2) > #define LS7A_UART_BASE 0x1fe001e0 > +#define LS7A_RTC_IRQ (PCH_PIC_IRQ_OFFSET + 3) > +#define LS7A_MISC_REG_BASE (LS7A_PCH_REG_BASE + 0x00080000) > +#define LS7A_RTC_REG_BASE (LS7A_MISC_REG_BASE + 0x00050100) > +#define LS7A_RTC_LEN 0x100 > #endif
diff --git a/MAINTAINERS b/MAINTAINERS index c22f95fb6a..9f4ee7978d 100644 --- a/MAINTAINERS +++ b/MAINTAINERS @@ -1137,6 +1137,7 @@ F: include/hw/loongarch/virt.h F: include/hw/intc/loongarch_*.h F: hw/intc/loongarch_*.c F: include/hw/pci-host/ls7a.h +F: hw/rtc/ls7a_rtc.c M68K Machines ------------- diff --git a/hw/loongarch/Kconfig b/hw/loongarch/Kconfig index 8552ff4bee..35b6680772 100644 --- a/hw/loongarch/Kconfig +++ b/hw/loongarch/Kconfig @@ -13,3 +13,4 @@ config LOONGARCH_VIRT select LOONGARCH_PCH_PIC select LOONGARCH_PCH_MSI select LOONGARCH_EXTIOI + select LS7A_RTC diff --git a/hw/loongarch/loongson3.c b/hw/loongarch/loongson3.c index 7bc17113dc..95984c9086 100644 --- a/hw/loongarch/loongson3.c +++ b/hw/loongarch/loongson3.c @@ -97,6 +97,9 @@ static void loongarch_devices_init(DeviceState *pch_pic) * Create some unimplemented devices to emulate this. */ create_unimplemented_device("pci-dma-cfg", 0x1001041c, 0x4); + sysbus_create_simple("ls7a_rtc", LS7A_RTC_REG_BASE, + qdev_get_gpio_in(pch_pic, + LS7A_RTC_IRQ - PCH_PIC_IRQ_OFFSET)); } static void loongarch_irq_init(LoongArchMachineState *lams) diff --git a/hw/rtc/Kconfig b/hw/rtc/Kconfig index 730c272bc5..d0d8dda084 100644 --- a/hw/rtc/Kconfig +++ b/hw/rtc/Kconfig @@ -27,3 +27,6 @@ config SUN4V_RTC config GOLDFISH_RTC bool + +config LS7A_RTC + bool diff --git a/hw/rtc/ls7a_rtc.c b/hw/rtc/ls7a_rtc.c new file mode 100644 index 0000000000..fe6710310f --- /dev/null +++ b/hw/rtc/ls7a_rtc.c @@ -0,0 +1,528 @@ +/* SPDX-License-Identifier: GPL-2.0-or-later */ +/* + * Loongarch LS7A Real Time Clock emulation + * + * Copyright (C) 2021 Loongson Technology Corporation Limited + */ + +#include "qemu/osdep.h" +#include "hw/sysbus.h" +#include "hw/irq.h" +#include "include/hw/register.h" +#include "qemu/timer.h" +#include "sysemu/sysemu.h" +#include "qemu/cutils.h" +#include "qemu/log.h" +#include "migration/vmstate.h" +#include "hw/misc/unimp.h" +#include "sysemu/rtc.h" +#include "hw/registerfields.h" + +#define SYS_TOYTRIM 0x20 +#define SYS_TOYWRITE0 0x24 +#define SYS_TOYWRITE1 0x28 +#define SYS_TOYREAD0 0x2C +#define SYS_TOYREAD1 0x30 +#define SYS_TOYMATCH0 0x34 +#define SYS_TOYMATCH1 0x38 +#define SYS_TOYMATCH2 0x3C +#define SYS_RTCCTRL 0x40 +#define SYS_RTCTRIM 0x60 +#define SYS_RTCWRTIE0 0x64 +#define SYS_RTCREAD0 0x68 +#define SYS_RTCMATCH0 0x6C +#define SYS_RTCMATCH1 0x70 +#define SYS_RTCMATCH2 0x74 + +#define LS7A_RTC_FREQ 32768 +#define TIMER_NUMS 3 +/* + * Shift bits and filed mask + */ + +FIELD(TOY, MON, 26, 6) +FIELD(TOY, DAY, 21, 5) +FIELD(TOY, HOUR, 16, 5) +FIELD(TOY, MIN, 10, 6) +FIELD(TOY, SEC, 4, 6) +FIELD(TOY, MSEC, 0, 4) + +FIELD(TOY_MATCH, YEAR, 26, 6) +FIELD(TOY_MATCH, MON, 22, 4) +FIELD(TOY_MATCH, DAY, 17, 5) +FIELD(TOY_MATCH, HOUR, 12, 5) +FIELD(TOY_MATCH, MIN, 6, 6) +FIELD(TOY_MATCH, SEC, 0, 6) + +FIELD(RTC_CTRL, RTCEN, 13, 1) +FIELD(RTC_CTRL, TOYEN, 11, 1) +FIELD(RTC_CTRL, EO, 8, 1) + +#define TYPE_LS7A_RTC "ls7a_rtc" +OBJECT_DECLARE_SIMPLE_TYPE(LS7ARtcState, LS7A_RTC) + +struct LS7ARtcState { + SysBusDevice parent_obj; + + MemoryRegion iomem; + /* + * Needed to preserve the tick_count across migration, even if the + * absolute value of the rtc_clock is different on the source and + * destination. + */ + int64_t offset_toy; + int64_t offset_rtc; + uint64_t save_toy_mon; + uint64_t save_toy_year; + uint64_t save_rtc; + int64_t data; + int tidx; + uint32_t toymatch[3]; + uint32_t toytrim; + uint32_t cntrctl; + uint32_t rtctrim; + uint32_t rtccount; + uint32_t rtcmatch[3]; + QEMUTimer *toy_timer[TIMER_NUMS]; + QEMUTimer *rtc_timer[TIMER_NUMS]; + qemu_irq irq; +}; + +/* switch nanoseconds time to rtc ticks */ +static inline uint64_t ls7a_rtc_ticks(void) +{ + return qemu_clock_get_ns(rtc_clock) * LS7A_RTC_FREQ / NANOSECONDS_PER_SECOND; +} + +/* switch rtc ticks to nanoseconds */ +static inline uint64_t ticks_to_ns(uint64_t ticks) +{ + return ticks * NANOSECONDS_PER_SECOND / LS7A_RTC_FREQ; +} + +static inline bool toy_enabled(LS7ARtcState *s) +{ + return FIELD_EX32(s->cntrctl, RTC_CTRL, TOYEN) && + FIELD_EX32(s->cntrctl, RTC_CTRL, EO); +} + +static inline bool rtc_enabled(LS7ARtcState *s) +{ + return FIELD_EX32(s->cntrctl, RTC_CTRL, RTCEN) && + FIELD_EX32(s->cntrctl, RTC_CTRL, EO); +} + +/* parse toy value to struct tm */ +static inline void toy_val_to_time_mon(uint64_t toy_val, struct tm *tm) +{ + tm->tm_sec = FIELD_EX32(toy_val, TOY, SEC); + tm->tm_min = FIELD_EX32(toy_val, TOY, MIN); + tm->tm_hour = FIELD_EX32(toy_val, TOY, HOUR); + tm->tm_mday = FIELD_EX32(toy_val, TOY, DAY); + tm->tm_mon = FIELD_EX32(toy_val, TOY, MON) - 1; +} + +static inline void toy_val_to_time_year(uint64_t toy_year, struct tm *tm) +{ + tm->tm_year = toy_year; +} + +/* parse struct tm to toy value */ +static inline uint64_t toy_time_to_val_mon(struct tm tm) +{ + uint64_t val = 0; + + val = FIELD_DP32(val, TOY, MON, tm.tm_mon + 1); + val = FIELD_DP32(val, TOY, DAY, tm.tm_mday); + val = FIELD_DP32(val, TOY, HOUR, tm.tm_hour); + val = FIELD_DP32(val, TOY, MIN, tm.tm_min); + val = FIELD_DP32(val, TOY, SEC, tm.tm_sec); + return val; +} + +static inline uint64_t toy_time_to_val_year(struct tm tm) +{ + uint64_t year; + + year = tm.tm_year; + return year; +} + +static inline void toymatch_val_to_time(uint64_t val, struct tm *tm) +{ + tm->tm_sec = FIELD_EX32(val, TOY_MATCH, SEC); + tm->tm_min = FIELD_EX32(val, TOY_MATCH, MIN); + tm->tm_hour = FIELD_EX32(val, TOY_MATCH, HOUR); + tm->tm_mday = FIELD_EX32(val, TOY_MATCH, DAY); + tm->tm_mon = FIELD_EX32(val, TOY_MATCH, MON) - 1; + tm->tm_year += (FIELD_EX32(val, TOY_MATCH, YEAR) - (tm->tm_year & 0x3f)); +} + +static void toymatch_write(LS7ARtcState *s, struct tm *tm, uint64_t val, int num) +{ + int64_t now, expire_time; + + /* it do not support write when toy disabled */ + if (toy_enabled(s)) { + s->toymatch[num] = val; + /* caculate expire time */ + now = qemu_clock_get_ms(rtc_clock); + toymatch_val_to_time(val, tm); + expire_time = now + (qemu_timedate_diff(tm) - s->offset_toy) * 1000; + timer_mod(s->toy_timer[num], expire_time); + } +} + +static void rtcmatch_write(LS7ARtcState *s, uint64_t val, int num) +{ + uint64_t expire_ns; + + /* it do not support write when toy disabled */ + if (rtc_enabled(s)) { + s->rtcmatch[num] = val; + /* caculate expire time */ + expire_ns = ticks_to_ns(val) - ticks_to_ns(s->offset_rtc); + timer_mod_ns(s->rtc_timer[num], expire_ns); + } +} + +static void ls7a_toy_stop(LS7ARtcState *s) +{ + int i; + struct tm tm; + /* + * save time when disabled toy, + * because toy time not add counters. + */ + qemu_get_timedate(&tm, s->offset_toy); + s->save_toy_mon = toy_time_to_val_mon(tm); + s->save_toy_year = toy_time_to_val_year(tm); + + /* delete timers, and when re-enabled, recaculate expire time */ + for (i = 0; i < TIMER_NUMS; i++) { + timer_del(s->toy_timer[i]); + } +} + +static void ls7a_rtc_stop(LS7ARtcState *s) +{ + int i; + uint64_t time; + + /* save rtc time */ + time = ls7a_rtc_ticks() + s->offset_rtc; + s->save_rtc = time; + + /* delete timers, and when re-enabled, recaculate expire time */ + for (i = 0; i < TIMER_NUMS; i++) { + timer_del(s->rtc_timer[i]); + } +} + +static void ls7a_toy_start(LS7ARtcState *s) +{ + int i; + uint64_t expire_time, now; + struct tm tm; + /* + * need to recaculate toy offset + * and expire time when enable it. + */ + toy_val_to_time_mon(s->save_toy_mon, &tm); + toy_val_to_time_year(s->save_toy_year, &tm); + + s->offset_toy = qemu_timedate_diff(&tm); + now = qemu_clock_get_ms(rtc_clock); + + /* recaculate expire time and enable timer */ + for (i = 0; i < TIMER_NUMS; i++) { + toymatch_val_to_time(s->toymatch[i], &tm); + expire_time = now + (qemu_timedate_diff(&tm) - s->offset_toy) * 1000; + timer_mod(s->toy_timer[i], expire_time); + } +} + +static void ls7a_rtc_start(LS7ARtcState *s) +{ + int i; + uint64_t expire_time, now; + + /* + * need to recaculate rtc offset + * and expire time when enable it. + */ + now = ls7a_rtc_ticks(); + s->offset_rtc = s->save_rtc - now; + + /* recaculate expire time and enable timer */ + for (i = 0; i < TIMER_NUMS; i++) { + expire_time = ticks_to_ns(s->rtcmatch[i]) - ticks_to_ns(s->offset_rtc); + timer_mod_ns(s->rtc_timer[i], expire_time); + } +} + +static uint64_t ls7a_rtc_read(void *opaque, hwaddr addr, unsigned size) +{ + LS7ARtcState *s = LS7A_RTC(opaque); + struct tm tm; + int val = 0; + + switch (addr) { + case SYS_TOYREAD0: + /* if toy disabled, read save toy time */ + if (toy_enabled(s)) { + qemu_get_timedate(&tm, s->offset_toy); + val = toy_time_to_val_mon(tm); + } else { + /* read save mon val */ + val = s->save_toy_mon; + } + break; + case SYS_TOYREAD1: + /* if toy disabled, read save toy time */ + if (toy_enabled(s)) { + qemu_get_timedate(&tm, s->offset_toy); + val = tm.tm_year; + } else { + /* read save year val */ + val = s->save_toy_year; + } + break; + case SYS_TOYMATCH0: + val = s->toymatch[0]; + break; + case SYS_TOYMATCH1: + val = s->toymatch[1]; + break; + case SYS_TOYMATCH2: + val = s->toymatch[2]; + break; + case SYS_RTCCTRL: + val = s->cntrctl; + break; + case SYS_RTCREAD0: + /* if rtc disabled, read save rtc time */ + if (rtc_enabled(s)) { + val = ls7a_rtc_ticks() + s->offset_rtc; + } else { + val = s->save_rtc; + } + break; + case SYS_RTCMATCH0: + val = s->rtcmatch[0]; + break; + case SYS_RTCMATCH1: + val = s->rtcmatch[1]; + break; + case SYS_RTCMATCH2: + val = s->rtcmatch[2]; + break; + default: + val = 0; + break; + } + return val; +} + +static void ls7a_rtc_write(void *opaque, hwaddr addr, + uint64_t val, unsigned size) +{ + int old_toyen, old_rtcen, new_toyen, new_rtcen; + LS7ARtcState *s = LS7A_RTC(opaque); + struct tm tm; + + switch (addr) { + case SYS_TOYWRITE0: + /* it do not support write when toy disabled */ + if (toy_enabled(s)) { + qemu_get_timedate(&tm, s->offset_toy); + tm.tm_sec = FIELD_EX32(val, TOY, SEC); + tm.tm_min = FIELD_EX32(val, TOY, MIN); + tm.tm_hour = FIELD_EX32(val, TOY, HOUR); + tm.tm_mday = FIELD_EX32(val, TOY, DAY); + tm.tm_mon = FIELD_EX32(val, TOY, MON) - 1; + s->offset_toy = qemu_timedate_diff(&tm); + } + break; + case SYS_TOYWRITE1: + if (toy_enabled(s)) { + qemu_get_timedate(&tm, s->offset_toy); + tm.tm_year = val; + s->offset_toy = qemu_timedate_diff(&tm); + } + break; + case SYS_TOYMATCH0: + toymatch_write(s, &tm, val, 0); + break; + case SYS_TOYMATCH1: + toymatch_write(s, &tm, val, 1); + break; + case SYS_TOYMATCH2: + toymatch_write(s, &tm, val, 2); + break; + case SYS_RTCCTRL: + /* get old ctrl */ + old_toyen = toy_enabled(s); + old_rtcen = rtc_enabled(s); + + s->cntrctl = val; + /* get new ctrl */ + new_toyen = toy_enabled(s); + new_rtcen = rtc_enabled(s); + + /* + * we do not consider if EO changed, as it always set at most time. + * toy or rtc enabled should start timer. otherwise, stop timer + */ + if (old_toyen != new_toyen) { + if (new_toyen) { + ls7a_toy_start(s); + } else { + ls7a_toy_stop(s); + } + } + if (old_rtcen != new_rtcen) { + if (new_rtcen) { + ls7a_rtc_start(s); + } else { + ls7a_rtc_stop(s); + } + } + break; + case SYS_RTCWRTIE0: + if (rtc_enabled(s)) { + s->offset_rtc = val - ls7a_rtc_ticks(); + } + break; + case SYS_RTCMATCH0: + rtcmatch_write(s, val, 0); + break; + case SYS_RTCMATCH1: + rtcmatch_write(s, val, 1); + break; + case SYS_RTCMATCH2: + rtcmatch_write(s, val, 2); + break; + default: + break; + } +} + +static const MemoryRegionOps ls7a_rtc_ops = { + .read = ls7a_rtc_read, + .write = ls7a_rtc_write, + .endianness = DEVICE_LITTLE_ENDIAN, + .valid = { + .min_access_size = 4, + .max_access_size = 4, + }, +}; + +static void toy_timer_cb(void *opaque) +{ + LS7ARtcState *s = opaque; + + if (toy_enabled(s)) { + qemu_irq_pulse(s->irq); + } +} + +static void rtc_timer_cb(void *opaque) +{ + LS7ARtcState *s = opaque; + + if (rtc_enabled(s)) { + qemu_irq_pulse(s->irq); + } +} + +static void ls7a_rtc_realize(DeviceState *dev, Error **errp) +{ + int i; + SysBusDevice *sbd = SYS_BUS_DEVICE(dev); + LS7ARtcState *d = LS7A_RTC(sbd); + memory_region_init_io(&d->iomem, NULL, &ls7a_rtc_ops, + (void *)d, "ls7a_rtc", 0x100); + + sysbus_init_irq(sbd, &d->irq); + + sysbus_init_mmio(sbd, &d->iomem); + for (i = 0; i < TIMER_NUMS; i++) { + d->toymatch[i] = 0; + d->rtcmatch[i] = 0; + d->toy_timer[i] = timer_new_ms(rtc_clock, toy_timer_cb, d); + d->rtc_timer[i] = timer_new_ms(rtc_clock, rtc_timer_cb, d); + } + d->offset_toy = 0; + d->offset_rtc = 0; + d->save_toy_mon = 0; + d->save_toy_year = 0; + d->save_rtc = 0; + + create_unimplemented_device("mmio fallback 1", 0x10013ffc, 0x4); +} + +static int ls7a_rtc_pre_save(void *opaque) +{ + LS7ARtcState *s = LS7A_RTC(opaque); + + ls7a_toy_stop(s); + ls7a_rtc_stop(s); + + return 0; +} + +static int ls7a_rtc_post_load(void *opaque, int version_id) +{ + LS7ARtcState *s = LS7A_RTC(opaque); + if (toy_enabled(s)) { + ls7a_toy_start(s); + } + + if (rtc_enabled(s)) { + ls7a_rtc_start(s); + } + + return 0; +} + +static const VMStateDescription vmstate_ls7a_rtc = { + .name = "ls7a_rtc", + .version_id = 1, + .minimum_version_id = 1, + .pre_save = ls7a_rtc_pre_save, + .post_load = ls7a_rtc_post_load, + .fields = (VMStateField[]) { + VMSTATE_INT64(offset_toy, LS7ARtcState), + VMSTATE_INT64(offset_rtc, LS7ARtcState), + VMSTATE_UINT64(save_toy_mon, LS7ARtcState), + VMSTATE_UINT64(save_toy_year, LS7ARtcState), + VMSTATE_UINT64(save_rtc, LS7ARtcState), + VMSTATE_UINT32_ARRAY(toymatch, LS7ARtcState, TIMER_NUMS), + VMSTATE_UINT32_ARRAY(rtcmatch, LS7ARtcState, TIMER_NUMS), + VMSTATE_UINT32(cntrctl, LS7ARtcState), + VMSTATE_END_OF_LIST() + } +}; + +static void ls7a_rtc_class_init(ObjectClass *klass, void *data) +{ + DeviceClass *dc = DEVICE_CLASS(klass); + dc->vmsd = &vmstate_ls7a_rtc; + dc->realize = ls7a_rtc_realize; + dc->desc = "ls7a rtc"; +} + +static const TypeInfo ls7a_rtc_info = { + .name = TYPE_LS7A_RTC, + .parent = TYPE_SYS_BUS_DEVICE, + .instance_size = sizeof(LS7ARtcState), + .class_init = ls7a_rtc_class_init, +}; + +static void ls7a_rtc_register_types(void) +{ + type_register_static(&ls7a_rtc_info); +} + +type_init(ls7a_rtc_register_types) diff --git a/hw/rtc/meson.build b/hw/rtc/meson.build index 7cecdee5dd..dc33973384 100644 --- a/hw/rtc/meson.build +++ b/hw/rtc/meson.build @@ -11,6 +11,7 @@ softmmu_ss.add(when: 'CONFIG_EXYNOS4', if_true: files('exynos4210_rtc.c')) softmmu_ss.add(when: 'CONFIG_SUN4V_RTC', if_true: files('sun4v-rtc.c')) softmmu_ss.add(when: 'CONFIG_ASPEED_SOC', if_true: files('aspeed_rtc.c')) softmmu_ss.add(when: 'CONFIG_GOLDFISH_RTC', if_true: files('goldfish_rtc.c')) +softmmu_ss.add(when: 'CONFIG_LS7A_RTC', if_true: files('ls7a_rtc.c')) softmmu_ss.add(when: 'CONFIG_ALLWINNER_H3', if_true: files('allwinner-rtc.c')) specific_ss.add(when: 'CONFIG_MC146818RTC', if_true: files('mc146818rtc.c')) diff --git a/include/hw/pci-host/ls7a.h b/include/hw/pci-host/ls7a.h index 5c653527f0..08c5f78be2 100644 --- a/include/hw/pci-host/ls7a.h +++ b/include/hw/pci-host/ls7a.h @@ -37,4 +37,8 @@ #define LS7A_PCI_IRQS 48 #define LS7A_UART_IRQ (PCH_PIC_IRQ_OFFSET + 2) #define LS7A_UART_BASE 0x1fe001e0 +#define LS7A_RTC_IRQ (PCH_PIC_IRQ_OFFSET + 3) +#define LS7A_MISC_REG_BASE (LS7A_PCH_REG_BASE + 0x00080000) +#define LS7A_RTC_REG_BASE (LS7A_MISC_REG_BASE + 0x00050100) +#define LS7A_RTC_LEN 0x100 #endif