git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/CORTEX_M4F_STM32F407ZG-SK/RegTest.s

   1 /*\r
   2  * FreeRTOS Kernel V10.2.1\r
   3  * Copyright (C) 2019 Amazon.com, Inc. or its affiliates.  All Rights Reserved.\r
   4  *\r
   5  * Permission is hereby granted, free of charge, to any person obtaining a copy of\r
   6  * this software and associated documentation files (the "Software"), to deal in\r
   7  * the Software without restriction, including without limitation the rights to\r
   8  * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of\r
   9  * the Software, and to permit persons to whom the Software is furnished to do so,\r
  10  * subject to the following conditions:\r
  11  *\r
  12  * The above copyright notice and this permission notice shall be included in all\r
  13  * copies or substantial portions of the Software.\r
  14  *\r
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR\r
  16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS\r
  17  * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR\r
  18  * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER\r
  19  * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN\r
  20  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.\r
  21  *\r
  22  * http://www.FreeRTOS.org\r
  23  * http://aws.amazon.com/freertos\r
  24  *\r
  25  * 1 tab == 4 spaces!\r
  26  */\r
  27 \r
  28 #include <FreeRTOSConfig.h>\r
  29 \r
  30 \r
  31         RSEG    CODE:CODE(2)\r
  32         thumb\r
  33 \r
  34         EXTERN ulRegTest1LoopCounter\r
  35         EXTERN ulRegTest2LoopCounter\r
  36 \r
  37         PUBLIC vRegTest1Task\r
  38         PUBLIC vRegTest2Task\r
  39         PUBLIC vRegTestClearFlopRegistersToParameterValue\r
  40         PUBLIC ulRegTestCheckFlopRegistersContainParameterValue\r
  41         \r
  42 /*-----------------------------------------------------------*/\r
  43 \r
  44 vRegTest1Task\r
  45 \r
  46         /* Fill the core registers with known values. */\r
  47         mov r0, #100\r
  48         mov r1, #101\r
  49         mov r2, #102\r
  50         mov r3, #103\r
  51         mov     r4, #104\r
  52         mov     r5, #105\r
  53         mov     r6, #106\r
  54         mov r7, #107\r
  55         mov     r8, #108\r
  56         mov     r9, #109\r
  57         mov     r10, #110\r
  58         mov     r11, #111\r
  59         mov r12, #112\r
  60 \r
  61         /* Fill the VFP registers with known values. */\r
  62         vmov d0, r0, r1\r
  63         vmov d1, r2, r3\r
  64         vmov d2, r4, r5\r
  65         vmov d3, r6, r7\r
  66         vmov d4, r8, r9\r
  67         vmov d5, r10, r11\r
  68         vmov d6, r0, r1\r
  69         vmov d7, r2, r3\r
  70         vmov d8, r4, r5\r
  71         vmov d9, r6, r7\r
  72         vmov d10, r8, r9\r
  73         vmov d11, r10, r11\r
  74         vmov d12, r0, r1\r
  75         vmov d13, r2, r3\r
  76         vmov d14, r4, r5\r
  77         vmov d15, r6, r7\r
  78 \r
  79 reg1_loop:\r
  80         /* Check all the VFP registers still contain the values set above.\r
  81         First save registers that are clobbered by the test. */\r
  82         push { r0-r1 }\r
  83         \r
  84         vmov r0, r1, d0\r
  85         cmp r0, #100\r
  86         bne reg1_error_loopf\r
  87         cmp r1, #101\r
  88         bne reg1_error_loopf\r
  89         vmov r0, r1, d1\r
  90         cmp r0, #102\r
  91         bne reg1_error_loopf\r
  92         cmp r1, #103\r
  93         bne reg1_error_loopf\r
  94         vmov r0, r1, d2\r
  95         cmp r0, #104\r
  96         bne reg1_error_loopf\r
  97         cmp r1, #105\r
  98         bne reg1_error_loopf\r
  99         vmov r0, r1, d3\r
 100         cmp r0, #106\r
 101         bne reg1_error_loopf\r
 102         cmp r1, #107\r
 103         bne reg1_error_loopf\r
 104         vmov r0, r1, d4\r
 105         cmp r0, #108\r
 106         bne reg1_error_loopf\r
 107         cmp r1, #109\r
 108         bne reg1_error_loopf\r
 109         vmov r0, r1, d5\r
 110         cmp r0, #110\r
 111         bne reg1_error_loopf\r
 112         cmp r1, #111\r
 113         bne reg1_error_loopf\r
 114         vmov r0, r1, d6\r
 115         cmp r0, #100\r
 116         bne reg1_error_loopf\r
 117         cmp r1, #101\r
 118         bne reg1_error_loopf\r
 119         vmov r0, r1, d7\r
 120         cmp r0, #102\r
 121         bne reg1_error_loopf\r
 122         cmp r1, #103\r
 123         bne reg1_error_loopf\r
 124         vmov r0, r1, d8\r
 125         cmp r0, #104\r
 126         bne reg1_error_loopf\r
 127         cmp r1, #105\r
 128         bne reg1_error_loopf\r
 129         vmov r0, r1, d9\r
 130         cmp r0, #106\r
 131         bne reg1_error_loopf\r
 132         cmp r1, #107\r
 133         bne reg1_error_loopf\r
 134         vmov r0, r1, d10\r
 135         cmp r0, #108\r
 136         bne reg1_error_loopf\r
 137         cmp r1, #109\r
 138         bne reg1_error_loopf\r
 139         vmov r0, r1, d11\r
 140         cmp r0, #110\r
 141         bne reg1_error_loopf\r
 142         cmp r1, #111\r
 143         bne reg1_error_loopf\r
 144         vmov r0, r1, d12\r
 145         cmp r0, #100\r
 146         bne reg1_error_loopf\r
 147         cmp r1, #101\r
 148         bne reg1_error_loopf\r
 149         vmov r0, r1, d13\r
 150         cmp r0, #102\r
 151         bne reg1_error_loopf\r
 152         cmp r1, #103\r
 153         bne reg1_error_loopf\r
 154         vmov r0, r1, d14\r
 155         cmp r0, #104\r
 156         bne reg1_error_loopf\r
 157         cmp r1, #105\r
 158         bne reg1_error_loopf\r
 159         vmov r0, r1, d15\r
 160         cmp r0, #106\r
 161         bne reg1_error_loopf\r
 162         cmp r1, #107\r
 163         bne reg1_error_loopf\r
 164         \r
 165         /* Restore the registers that were clobbered by the test. */\r
 166         pop {r0-r1}\r
 167         \r
 168         /* VFP register test passed.  Jump to the core register test. */\r
 169         b reg1_loopf_pass\r
 170 \r
 171 reg1_error_loopf\r
 172         /* If this line is hit then a VFP register value was found to be\r
 173         incorrect. */\r
 174         b reg1_error_loopf\r
 175 \r
 176 reg1_loopf_pass\r
 177 \r
 178         cmp     r0, #100\r
 179         bne     reg1_error_loop\r
 180         cmp     r1, #101\r
 181         bne     reg1_error_loop\r
 182         cmp     r2, #102\r
 183         bne     reg1_error_loop\r
 184         cmp r3, #103\r
 185         bne     reg1_error_loop\r
 186         cmp     r4, #104\r
 187         bne     reg1_error_loop\r
 188         cmp     r5, #105\r
 189         bne     reg1_error_loop\r
 190         cmp     r6, #106\r
 191         bne     reg1_error_loop\r
 192         cmp     r7, #107\r
 193         bne     reg1_error_loop\r
 194         cmp     r8, #108\r
 195         bne     reg1_error_loop\r
 196         cmp     r9, #109\r
 197         bne     reg1_error_loop\r
 198         cmp     r10, #110\r
 199         bne     reg1_error_loop\r
 200         cmp     r11, #111\r
 201         bne     reg1_error_loop\r
 202         cmp     r12, #112\r
 203         bne     reg1_error_loop\r
 204         \r
 205         /* Everything passed, increment the loop counter. */\r
 206         push { r0-r1 }\r
 207         ldr     r0, =ulRegTest1LoopCounter\r
 208         ldr r1, [r0]\r
 209         adds r1, r1, #1\r
 210         str r1, [r0]\r
 211         pop { r0-r1 }\r
 212         \r
 213         /* Start again. */\r
 214         b reg1_loop\r
 215 \r
 216 reg1_error_loop:\r
 217         /* If this line is hit then there was an error in a core register value.\r
 218         The loop ensures the loop counter stops incrementing. */\r
 219         b reg1_error_loop\r
 220 \r
 221 /*-----------------------------------------------------------*/\r
 222 \r
 223 \r
 224 vRegTest2Task\r
 225 \r
 226         /* Set all the core registers to known values. */\r
 227         mov r0, #-1\r
 228         mov r1, #1\r
 229         mov r2, #2\r
 230         mov r3, #3\r
 231         mov     r4, #4\r
 232         mov     r5, #5\r
 233         mov     r6, #6\r
 234         mov r7, #7\r
 235         mov     r8, #8\r
 236         mov     r9, #9\r
 237         mov     r10, #10\r
 238         mov     r11, #11\r
 239         mov r12, #12\r
 240 \r
 241         /* Set all the VFP to known values. */\r
 242         vmov d0, r0, r1\r
 243         vmov d1, r2, r3\r
 244         vmov d2, r4, r5\r
 245         vmov d3, r6, r7\r
 246         vmov d4, r8, r9\r
 247         vmov d5, r10, r11\r
 248         vmov d6, r0, r1\r
 249         vmov d7, r2, r3\r
 250         vmov d8, r4, r5\r
 251         vmov d9, r6, r7\r
 252         vmov d10, r8, r9\r
 253         vmov d11, r10, r11\r
 254         vmov d12, r0, r1\r
 255         vmov d13, r2, r3\r
 256         vmov d14, r4, r5\r
 257         vmov d15, r6, r7\r
 258 \r
 259 reg2_loop:\r
 260         \r
 261         /* Check all the VFP registers still contain the values set above.\r
 262         First save registers that are clobbered by the test. */\r
 263         push { r0-r1 }\r
 264         \r
 265         vmov r0, r1, d0\r
 266         cmp r0, #-1\r
 267         bne reg2_error_loopf\r
 268         cmp r1, #1\r
 269         bne reg2_error_loopf\r
 270         vmov r0, r1, d1\r
 271         cmp r0, #2\r
 272         bne reg2_error_loopf\r
 273         cmp r1, #3\r
 274         bne reg2_error_loopf\r
 275         vmov r0, r1, d2\r
 276         cmp r0, #4\r
 277         bne reg2_error_loopf\r
 278         cmp r1, #5\r
 279         bne reg2_error_loopf\r
 280         vmov r0, r1, d3\r
 281         cmp r0, #6\r
 282         bne reg2_error_loopf\r
 283         cmp r1, #7\r
 284         bne reg2_error_loopf\r
 285         vmov r0, r1, d4\r
 286         cmp r0, #8\r
 287         bne reg2_error_loopf\r
 288         cmp r1, #9\r
 289         bne reg2_error_loopf\r
 290         vmov r0, r1, d5\r
 291         cmp r0, #10\r
 292         bne reg2_error_loopf\r
 293         cmp r1, #11\r
 294         bne reg2_error_loopf\r
 295         vmov r0, r1, d6\r
 296         cmp r0, #-1\r
 297         bne reg2_error_loopf\r
 298         cmp r1, #1\r
 299         bne reg2_error_loopf\r
 300         vmov r0, r1, d7\r
 301         cmp r0, #2\r
 302         bne reg2_error_loopf\r
 303         cmp r1, #3\r
 304         bne reg2_error_loopf\r
 305         vmov r0, r1, d8\r
 306         cmp r0, #4\r
 307         bne reg2_error_loopf\r
 308         cmp r1, #5\r
 309         bne reg2_error_loopf\r
 310         vmov r0, r1, d9\r
 311         cmp r0, #6\r
 312         bne reg2_error_loopf\r
 313         cmp r1, #7\r
 314         bne reg2_error_loopf\r
 315         vmov r0, r1, d10\r
 316         cmp r0, #8\r
 317         bne reg2_error_loopf\r
 318         cmp r1, #9\r
 319         bne reg2_error_loopf\r
 320         vmov r0, r1, d11\r
 321         cmp r0, #10\r
 322         bne reg2_error_loopf\r
 323         cmp r1, #11\r
 324         bne reg2_error_loopf\r
 325         vmov r0, r1, d12\r
 326         cmp r0, #-1\r
 327         bne reg2_error_loopf\r
 328         cmp r1, #1\r
 329         bne reg2_error_loopf\r
 330         vmov r0, r1, d13\r
 331         cmp r0, #2\r
 332         bne reg2_error_loopf\r
 333         cmp r1, #3\r
 334         bne reg2_error_loopf\r
 335         vmov r0, r1, d14\r
 336         cmp r0, #4\r
 337         bne reg2_error_loopf\r
 338         cmp r1, #5\r
 339         bne reg2_error_loopf\r
 340         vmov r0, r1, d15\r
 341         cmp r0, #6\r
 342         bne reg2_error_loopf\r
 343         cmp r1, #7\r
 344         bne reg2_error_loopf\r
 345         \r
 346         /* Restore the registers that were clobbered by the test. */\r
 347         pop {r0-r1}\r
 348         \r
 349         /* VFP register test passed.  Jump to the core register test. */\r
 350         b reg2_loopf_pass\r
 351 \r
 352 reg2_error_loopf\r
 353         /* If this line is hit then a VFP register value was found to be\r
 354         incorrect. */\r
 355         b reg2_error_loopf\r
 356 \r
 357 reg2_loopf_pass\r
 358 \r
 359         cmp     r0, #-1\r
 360         bne     reg2_error_loop\r
 361         cmp     r1, #1\r
 362         bne     reg2_error_loop\r
 363         cmp     r2, #2\r
 364         bne     reg2_error_loop\r
 365         cmp r3, #3\r
 366         bne     reg2_error_loop\r
 367         cmp     r4, #4\r
 368         bne     reg2_error_loop\r
 369         cmp     r5, #5\r
 370         bne     reg2_error_loop\r
 371         cmp     r6, #6\r
 372         bne     reg2_error_loop\r
 373         cmp     r7, #7\r
 374         bne     reg2_error_loop\r
 375         cmp     r8, #8\r
 376         bne     reg2_error_loop\r
 377         cmp     r9, #9\r
 378         bne     reg2_error_loop\r
 379         cmp     r10, #10\r
 380         bne     reg2_error_loop\r
 381         cmp     r11, #11\r
 382         bne     reg2_error_loop\r
 383         cmp     r12, #12\r
 384         bne     reg2_error_loop\r
 385         \r
 386         /* Increment the loop counter to indicate this test is still functioning\r
 387         correctly. */\r
 388         push { r0-r1 }\r
 389         ldr     r0, =ulRegTest2LoopCounter\r
 390         ldr r1, [r0]\r
 391         adds r1, r1, #1\r
 392         str r1, [r0]\r
 393         pop { r0-r1 }\r
 394         \r
 395         /* Start again. */\r
 396         b reg2_loop\r
 397 \r
 398 reg2_error_loop:\r
 399         /* If this line is hit then there was an error in a core register value.\r
 400         This loop ensures the loop counter variable stops incrementing. */\r
 401         b reg2_error_loop\r
 402 \r
 403 /*-----------------------------------------------------------*/\r
 404 \r
 405 vRegTestClearFlopRegistersToParameterValue\r
 406 \r
 407         /* Clobber the auto saved registers. */\r
 408         vmov d0, r0, r0\r
 409         vmov d1, r0, r0\r
 410         vmov d2, r0, r0\r
 411         vmov d3, r0, r0\r
 412         vmov d4, r0, r0\r
 413         vmov d5, r0, r0\r
 414         vmov d6, r0, r0\r
 415         vmov d7, r0, r0\r
 416         bx lr\r
 417 \r
 418 /*-----------------------------------------------------------*/\r
 419 \r
 420 ulRegTestCheckFlopRegistersContainParameterValue\r
 421 \r
 422         vmov r1, s0\r
 423         cmp r0, r1\r
 424         bne return_error\r
 425         vmov r1, s1\r
 426         cmp r0, r1\r
 427         bne return_error\r
 428         vmov r1, s2\r
 429         cmp r0, r1\r
 430         bne return_error\r
 431         vmov r1, s3\r
 432         cmp r0, r1\r
 433         bne return_error\r
 434         vmov r1, s4\r
 435         cmp r0, r1\r
 436         bne return_error\r
 437         vmov r1, s5\r
 438         cmp r0, r1\r
 439         bne return_error\r
 440         vmov r1, s6\r
 441         cmp r0, r1\r
 442         bne return_error\r
 443         vmov r1, s7\r
 444         cmp r0, r1\r
 445         bne return_error\r
 446         vmov r1, s8\r
 447         cmp r0, r1\r
 448         bne return_error\r
 449         vmov r1, s9\r
 450         cmp r0, r1\r
 451         bne return_error\r
 452         vmov r1, s10\r
 453         cmp r0, r1\r
 454         bne return_error\r
 455         vmov r1, s11\r
 456         cmp r0, r1\r
 457         bne return_error\r
 458         vmov r1, s12\r
 459         cmp r0, r1\r
 460         bne return_error\r
 461         vmov r1, s13\r
 462         cmp r0, r1\r
 463         bne return_error\r
 464         vmov r1, s14\r
 465         cmp r0, r1\r
 466         bne return_error\r
 467         vmov r1, s15\r
 468         cmp r0, r1\r
 469         bne return_error\r
 470         \r
 471 return_pass\r
 472         mov r0, #1\r
 473         bx lr\r
 474 \r
 475 return_error\r
 476         mov r0, #0\r
 477         bx lr\r
 478 \r
 479         END\r
 480         \r