1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Copyright (C) 2000,2001,2004 Broadcom Corporation
4  */
5 #include <linux/clocksource.h>
6 #include <linux/sched_clock.h>
7 
8 #include <asm/addrspace.h>
9 #include <asm/io.h>
10 #include <asm/time.h>
11 
12 #include <asm/sibyte/bcm1480_regs.h>
13 #include <asm/sibyte/sb1250_regs.h>
14 #include <asm/sibyte/bcm1480_int.h>
15 #include <asm/sibyte/bcm1480_scd.h>
16 
17 #include <asm/sibyte/sb1250.h>
18 
bcm1480_hpt_read(struct clocksource * cs)19 static u64 bcm1480_hpt_read(struct clocksource *cs)
20 {
21 	return (u64) __raw_readq(IOADDR(A_SCD_ZBBUS_CYCLE_COUNT));
22 }
23 
24 struct clocksource bcm1480_clocksource = {
25 	.name	= "zbbus-cycles",
26 	.rating = 200,
27 	.read	= bcm1480_hpt_read,
28 	.mask	= CLOCKSOURCE_MASK(64),
29 	.flags	= CLOCK_SOURCE_IS_CONTINUOUS,
30 };
31 
sb1480_read_sched_clock(void)32 static u64 notrace sb1480_read_sched_clock(void)
33 {
34 	return __raw_readq(IOADDR(A_SCD_ZBBUS_CYCLE_COUNT));
35 }
36 
sb1480_clocksource_init(void)37 void __init sb1480_clocksource_init(void)
38 {
39 	struct clocksource *cs = &bcm1480_clocksource;
40 	unsigned int plldiv;
41 	unsigned long zbbus;
42 
43 	plldiv = G_BCM1480_SYS_PLL_DIV(__raw_readq(IOADDR(A_SCD_SYSTEM_CFG)));
44 	zbbus = ((plldiv >> 1) * 50000000) + ((plldiv & 1) * 25000000);
45 	clocksource_register_hz(cs, zbbus);
46 
47 	sched_clock_register(sb1480_read_sched_clock, 64, zbbus);
48 }
49