1 /*
2  * QTest testcase for STM32L4x5_RCC
3  *
4  * Copyright (c) 2023 Arnaud Minier <arnaud.minier@telecom-paris.fr>
5  * Copyright (c) 2023 Inès Varhol <ines.varhol@telecom-paris.fr>
6  *
7  * SPDX-License-Identifier: GPL-2.0-or-later
8  *
9  * This work is licensed under the terms of the GNU GPL, version 2 or later.
10  * See the COPYING file in the top-level directory.
11  */
12 
13 #include "qemu/osdep.h"
14 #include "hw/registerfields.h"
15 #include "libqtest-single.h"
16 #include "hw/misc/stm32l4x5_rcc_internals.h"
17 
18 #define RCC_BASE_ADDR 0x40021000
19 #define NVIC_ISER 0xE000E100
20 #define NVIC_ISPR 0xE000E200
21 #define NVIC_ICPR 0xE000E280
22 #define RCC_IRQ 5
23 
enable_nvic_irq(unsigned int n)24 static void enable_nvic_irq(unsigned int n)
25 {
26     writel(NVIC_ISER, 1 << n);
27 }
28 
unpend_nvic_irq(unsigned int n)29 static void unpend_nvic_irq(unsigned int n)
30 {
31     writel(NVIC_ICPR, 1 << n);
32 }
33 
check_nvic_pending(unsigned int n)34 static bool check_nvic_pending(unsigned int n)
35 {
36     return readl(NVIC_ISPR) & (1 << n);
37 }
38 
rcc_writel(unsigned int offset,uint32_t value)39 static void rcc_writel(unsigned int offset, uint32_t value)
40 {
41     writel(RCC_BASE_ADDR + offset, value);
42 }
43 
rcc_readl(unsigned int offset)44 static uint32_t rcc_readl(unsigned int offset)
45 {
46     return readl(RCC_BASE_ADDR + offset);
47 }
48 
test_init_msi(void)49 static void test_init_msi(void)
50 {
51     /* MSIRANGE can be set only when MSI is OFF or READY */
52     rcc_writel(A_CR, R_CR_MSION_MASK);
53     /* Wait until MSI is stable */
54     g_assert_true((rcc_readl(A_CR) & R_CR_MSIRDY_MASK) == R_CR_MSIRDY_MASK);
55     /* TODO find a way to test MSI value */
56 }
57 
test_set_msi_as_sysclk(void)58 static void test_set_msi_as_sysclk(void)
59 {
60     /* Clocking from MSI, in case MSI was not the default source */
61     rcc_writel(A_CFGR, 0);
62     /* Wait until MSI is selected and stable */
63     g_assert_true((rcc_readl(A_CFGR) & R_CFGR_SWS_MASK) == 0);
64 }
65 
test_init_pll(void)66 static void test_init_pll(void)
67 {
68     uint32_t value;
69 
70     /*
71      * Update PLL and set MSI as the source clock.
72      * PLLM = 1 --> 000
73      * PLLN = 40 --> 40
74      * PPLLR = 2 --> 00
75      * PLLDIV = unused, PLLP = unused (SAI3), PLLQ = unused (48M1)
76      * SRC = MSI --> 01
77      */
78     rcc_writel(A_PLLCFGR, R_PLLCFGR_PLLREN_MASK |
79             (40 << R_PLLCFGR_PLLN_SHIFT) |
80             (0b01 << R_PLLCFGR_PLLSRC_SHIFT));
81 
82     /* PLL activation */
83     value = rcc_readl(A_CR);
84     rcc_writel(A_CR, value | R_CR_PLLON_MASK);
85 
86     /* Waiting for PLL lock. */
87     g_assert_true((rcc_readl(A_CR) & R_CR_PLLRDY_MASK) == R_CR_PLLRDY_MASK);
88 
89     /* Switches on the PLL clock source */
90     value = rcc_readl(A_CFGR);
91     rcc_writel(A_CFGR, (value & ~R_CFGR_SW_MASK) |
92         (0b11 << R_CFGR_SW_SHIFT));
93 
94     /* Wait until SYSCLK is stable. */
95     g_assert_true((rcc_readl(A_CFGR) & R_CFGR_SWS_MASK) ==
96         (0b11 << R_CFGR_SWS_SHIFT));
97 }
98 
test_activate_lse(void)99 static void test_activate_lse(void)
100 {
101     /* LSE activation, no LSE Bypass */
102     rcc_writel(A_BDCR, R_BDCR_LSEDRV_MASK | R_BDCR_LSEON_MASK);
103     g_assert_true((rcc_readl(A_BDCR) & R_BDCR_LSERDY_MASK) == R_BDCR_LSERDY_MASK);
104 }
105 
test_irq(void)106 static void test_irq(void)
107 {
108     enable_nvic_irq(RCC_IRQ);
109 
110     rcc_writel(A_CIER, R_CIER_LSIRDYIE_MASK);
111     rcc_writel(A_CSR, R_CSR_LSION_MASK);
112     g_assert_true(check_nvic_pending(RCC_IRQ));
113     rcc_writel(A_CICR, R_CICR_LSIRDYC_MASK);
114     unpend_nvic_irq(RCC_IRQ);
115 
116     rcc_writel(A_CIER, R_CIER_LSERDYIE_MASK);
117     rcc_writel(A_BDCR, R_BDCR_LSEON_MASK);
118     g_assert_true(check_nvic_pending(RCC_IRQ));
119     rcc_writel(A_CICR, R_CICR_LSERDYC_MASK);
120     unpend_nvic_irq(RCC_IRQ);
121 
122     /*
123      * MSI has been enabled by previous tests,
124      * shouln't generate an interruption.
125      */
126     rcc_writel(A_CIER, R_CIER_MSIRDYIE_MASK);
127     rcc_writel(A_CR, R_CR_MSION_MASK);
128     g_assert_false(check_nvic_pending(RCC_IRQ));
129 
130     rcc_writel(A_CIER, R_CIER_HSIRDYIE_MASK);
131     rcc_writel(A_CR, R_CR_HSION_MASK);
132     g_assert_true(check_nvic_pending(RCC_IRQ));
133     rcc_writel(A_CICR, R_CICR_HSIRDYC_MASK);
134     unpend_nvic_irq(RCC_IRQ);
135 
136     rcc_writel(A_CIER, R_CIER_HSERDYIE_MASK);
137     rcc_writel(A_CR, R_CR_HSEON_MASK);
138     g_assert_true(check_nvic_pending(RCC_IRQ));
139     rcc_writel(A_CICR, R_CICR_HSERDYC_MASK);
140     unpend_nvic_irq(RCC_IRQ);
141 
142     /*
143      * PLL has been enabled by previous tests,
144      * shouln't generate an interruption.
145      */
146     rcc_writel(A_CIER, R_CIER_PLLRDYIE_MASK);
147     rcc_writel(A_CR, R_CR_PLLON_MASK);
148     g_assert_false(check_nvic_pending(RCC_IRQ));
149 
150     rcc_writel(A_CIER, R_CIER_PLLSAI1RDYIE_MASK);
151     rcc_writel(A_CR, R_CR_PLLSAI1ON_MASK);
152     g_assert_true(check_nvic_pending(RCC_IRQ));
153     rcc_writel(A_CICR, R_CICR_PLLSAI1RDYC_MASK);
154     unpend_nvic_irq(RCC_IRQ);
155 
156     rcc_writel(A_CIER, R_CIER_PLLSAI2RDYIE_MASK);
157     rcc_writel(A_CR, R_CR_PLLSAI2ON_MASK);
158     g_assert_true(check_nvic_pending(RCC_IRQ));
159     rcc_writel(A_CICR, R_CICR_PLLSAI2RDYC_MASK);
160     unpend_nvic_irq(RCC_IRQ);
161 }
162 
main(int argc,char ** argv)163 int main(int argc, char **argv)
164 {
165     int ret;
166 
167     g_test_init(&argc, &argv, NULL);
168     g_test_set_nonfatal_assertions();
169     /*
170      * These test separately that we can enable the plls, change the sysclk,
171      * and enable different devices.
172      * They are dependent on one another.
173      * We assume that all operations that would take some time to have an effect
174      * (e.g. changing the PLL frequency) are done instantaneously.
175      */
176     qtest_add_func("stm32l4x5/rcc/init_msi", test_init_msi);
177     qtest_add_func("stm32l4x5/rcc/set_msi_as_sysclk",
178         test_set_msi_as_sysclk);
179     qtest_add_func("stm32l4x5/rcc/activate_lse", test_activate_lse);
180     qtest_add_func("stm32l4x5/rcc/init_pll", test_init_pll);
181 
182     qtest_add_func("stm32l4x5/rcc/irq", test_irq);
183 
184     qtest_start("-machine b-l475e-iot01a");
185     ret = g_test_run();
186     qtest_end();
187 
188     return ret;
189 }
190