summaryrefslogtreecommitdiff
path: root/platform/generic/starfive/dubhe_cache.S
blob: d0b3f94ff3d722ba98a4600c75a9e2ea99b55fa7 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
/*
 * SPDX-License-Identifier: BSD-2-Clause
 *
 * Copyright (c) 2022 StarFive Technology Co., Ltd.
 *
 * Author: Chee Hong Ang <cheehong.ang@linux.starfivetech.com>
 *
 */

#define DUBHE_L2_CACHELINE_SIZE	0x40

	/*
	 * __sbi_dubhe_L2_inv_range(start,len)
	 *
	 * Invalidate the L2 cache within the specified region
	 *
	 * start - physical start address of region
	 * len   - size of memory region
	 */

	.align 3
	.global __sbi_dubhe_L2_inv_range
__sbi_dubhe_L2_inv_range:
	beqz	a1, 4f
	li	t0, DUBHE_L2_CACHELINE_SIZE
	addi	t1, t0, -1
	add	a1, a1, a0	/* Compute end address */
	and	t2, a0, t1
	not	t3, t1
	and	a0, a0, t3
	beqz	t2, 1f
	/* CFLUSH.L2 rs1 = a0 */
	fence	rw, rw
	.insn i 0x73, 0, x0, a0, -0x3C
	fence	rw, rw
	add	a0, a0, t0
1:
	and	t2, a1, t1
	not	t3, t1
	and	a1, a1, t3
	beqz	t2, 2f
	/* CFLUSH.L2 rs1 = a1 */
	fence	rw, rw
	.insn i 0x73, 0, x0, a1, -0x3C
	fence	rw, rw
2:
	bge	a0, a1, 4f
3:
	/* CDISCARD.L2 rs1 = a0 */
	fence	rw, rw
	.insn i 0x73, 0, x0, a0, -0x3A
	fence	rw, rw
	add	a0, a0, t0
	blt	a0, a1, 3b
4:
	ret

	/*
	 * __sbi_dubhe_L2_flush_range(start,len)
	 *
	 * Flush and invalidate the L2 cache within the specified region
	 *
	 * start - physical start address of region
	 * len   - size of memory region
	 */

	.align 3
	.global __sbi_dubhe_L2_flush_range
__sbi_dubhe_L2_flush_range:
	beqz	a1, 2f
	li	t0, DUBHE_L2_CACHELINE_SIZE
	addi	t1, t0, -1
	add	a1, a1, a0	/* Compute end address */
	not	t2, t1
	and	a0, a0, t2
1:
	/* CFLUSH.L2 rs1 = a0 */
	fence	rw, rw
	.insn i 0x73, 0, x0, a0, -0x3C
	fence	rw, rw
	add	a0, a0, t0
	blt	a0, a1, 1b
2:
	ret