1/*
 2 * Support code for virtual Ranchu board for MIPS.
 3 *
 4 * Author: Miodrag Dinic <miodrag.dinic@mips.com>
 5 *
 6 * This program is free software; you can redistribute it and/or modify it
 7 * under the terms of the GNU General Public License as published by the
 8 * Free Software Foundation;  either version 2 of the  License, or (at your
 9 * option) any later version.
10 */
11
12#include <linux/of_address.h>
13#include <linux/types.h>
14
15#include <asm/machine.h>
16#include <asm/mipsregs.h>
17#include <asm/time.h>
18
19#define GOLDFISH_TIMER_LOW		0x00
20#define GOLDFISH_TIMER_HIGH		0x04
21
22static __init u64 read_rtc_time(void __iomem *base)
23{
24	u32 time_low;
25	u32 time_high;
26
27	/*
28	 * Reading the low address latches the high value
29	 * as well so there is no fear that we may read
30	 * inaccurate high value.
31	 */
32	time_low = readl(base + GOLDFISH_TIMER_LOW);
33	time_high = readl(base + GOLDFISH_TIMER_HIGH);
34
35	return ((u64)time_high << 32) | time_low;
36}
37
38static __init unsigned int ranchu_measure_hpt_freq(void)
39{
40	u64 rtc_start, rtc_current, rtc_delta;
41	unsigned int start, count;
42	struct device_node *np;
43	void __iomem *rtc_base;
44
45	np = of_find_compatible_node(NULL, NULL, "google,goldfish-rtc");
46	if (!np)
47		panic("%s(): Failed to find 'google,goldfish-rtc' dt node!",
48		      __func__);
49
50	rtc_base = of_iomap(np, 0);
51	if (!rtc_base)
52		panic("%s(): Failed to ioremap Goldfish RTC base!", __func__);
53
54	/*
55	 * Poll the nanosecond resolution RTC for one
56	 * second to calibrate the CPU frequency.
57	 */
58	rtc_start = read_rtc_time(rtc_base);
59	start = read_c0_count();
60
61	do {
62		rtc_current = read_rtc_time(rtc_base);
63		rtc_delta = rtc_current - rtc_start;
64	} while (rtc_delta < NSEC_PER_SEC);
65
66	count = read_c0_count() - start;
67
68	/*
69	 * Make sure the frequency will be a round number.
70	 * Without this correction, the returned value may vary
71	 * between subsequent emulation executions.
72	 *
73	 * TODO: Set this value using device tree.
74	 */
75	count += 5000;
76	count -= count % 10000;
77
78	iounmap(rtc_base);
79
80	return count;
81}
82
83static const struct of_device_id ranchu_of_match[] __initconst = {
84	{
85		.compatible = "mti,ranchu",
86	},
87	{}
88};
89
90MIPS_MACHINE(ranchu) = {
91	.matches = ranchu_of_match,
92	.measure_hpt_freq = ranchu_measure_hpt_freq,
93};

 1// SPDX-License-Identifier: GPL-2.0-or-later
 2/*
 3 * Support code for virtual Ranchu board for MIPS.
 4 *
 5 * Author: Miodrag Dinic <miodrag.dinic@mips.com>
 
 
 
 
 
 6 */
 7
 8#include <linux/of_address.h>
 9#include <linux/types.h>
10
11#include <asm/machine.h>
12#include <asm/mipsregs.h>
13#include <asm/time.h>
14
15#define GOLDFISH_TIMER_LOW		0x00
16#define GOLDFISH_TIMER_HIGH		0x04
17
18static __init u64 read_rtc_time(void __iomem *base)
19{
20	u32 time_low;
21	u32 time_high;
22
23	/*
24	 * Reading the low address latches the high value
25	 * as well so there is no fear that we may read
26	 * inaccurate high value.
27	 */
28	time_low = readl(base + GOLDFISH_TIMER_LOW);
29	time_high = readl(base + GOLDFISH_TIMER_HIGH);
30
31	return ((u64)time_high << 32) | time_low;
32}
33
34static __init unsigned int ranchu_measure_hpt_freq(void)
35{
36	u64 rtc_start, rtc_current, rtc_delta;
37	unsigned int start, count;
38	struct device_node *np;
39	void __iomem *rtc_base;
40
41	np = of_find_compatible_node(NULL, NULL, "google,goldfish-rtc");
42	if (!np)
43		panic("%s(): Failed to find 'google,goldfish-rtc' dt node!",
44		      __func__);
45
46	rtc_base = of_iomap(np, 0);
47	if (!rtc_base)
48		panic("%s(): Failed to ioremap Goldfish RTC base!", __func__);
49
50	/*
51	 * Poll the nanosecond resolution RTC for one
52	 * second to calibrate the CPU frequency.
53	 */
54	rtc_start = read_rtc_time(rtc_base);
55	start = read_c0_count();
56
57	do {
58		rtc_current = read_rtc_time(rtc_base);
59		rtc_delta = rtc_current - rtc_start;
60	} while (rtc_delta < NSEC_PER_SEC);
61
62	count = read_c0_count() - start;
63
64	/*
65	 * Make sure the frequency will be a round number.
66	 * Without this correction, the returned value may vary
67	 * between subsequent emulation executions.
68	 *
69	 * TODO: Set this value using device tree.
70	 */
71	count += 5000;
72	count -= count % 10000;
73
74	iounmap(rtc_base);
75
76	return count;
77}
78
79static const struct of_device_id ranchu_of_match[] __initconst = {
80	{
81		.compatible = "mti,ranchu",
82	},
83	{}
84};
85
86MIPS_MACHINE(ranchu) = {
87	.matches = ranchu_of_match,
88	.measure_hpt_freq = ranchu_measure_hpt_freq,
89};