QuakeGod
2024-07-27 842bb64195f958b050867c50db66fc0aa413dafb
提交 | 用户 | age
483170 1 /**************************************************************************//**
Q 2  * @file     cmsis_armcc_V6.h
3  * @brief    CMSIS Cortex-M Core Function/Instruction Header File
4  * @version  V4.30
5  * @date     20. October 2015
6  ******************************************************************************/
7 /* Copyright (c) 2009 - 2015 ARM LIMITED
8
9    All rights reserved.
10    Redistribution and use in source and binary forms, with or without
11    modification, are permitted provided that the following conditions are met:
12    - Redistributions of source code must retain the above copyright
13      notice, this list of conditions and the following disclaimer.
14    - Redistributions in binary form must reproduce the above copyright
15      notice, this list of conditions and the following disclaimer in the
16      documentation and/or other materials provided with the distribution.
17    - Neither the name of ARM nor the names of its contributors may be used
18      to endorse or promote products derived from this software without
19      specific prior written permission.
20    *
21    THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
22    AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23    IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24    ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE
25    LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
26    CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
27    SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
28    INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
29    CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30    ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31    POSSIBILITY OF SUCH DAMAGE.
32    ---------------------------------------------------------------------------*/
33
34
35 #ifndef __CMSIS_ARMCC_V6_H
36 #define __CMSIS_ARMCC_V6_H
37
38
39 /* ###########################  Core Function Access  ########################### */
40 /** \ingroup  CMSIS_Core_FunctionInterface
41     \defgroup CMSIS_Core_RegAccFunctions CMSIS Core Register Access Functions
42   @{
43  */
44
45 /**
46   \brief   Enable IRQ Interrupts
47   \details Enables IRQ interrupts by clearing the I-bit in the CPSR.
48            Can only be executed in Privileged modes.
49  */
50 __attribute__((always_inline)) __STATIC_INLINE void __enable_irq(void)
51 {
52   __ASM volatile ("cpsie i" : : : "memory");
53 }
54
55
56 /**
57   \brief   Disable IRQ Interrupts
58   \details Disables IRQ interrupts by setting the I-bit in the CPSR.
59            Can only be executed in Privileged modes.
60  */
61 __attribute__((always_inline)) __STATIC_INLINE void __disable_irq(void)
62 {
63   __ASM volatile ("cpsid i" : : : "memory");
64 }
65
66
67 /**
68   \brief   Get Control Register
69   \details Returns the content of the Control Register.
70   \return               Control Register value
71  */
72 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_CONTROL(void)
73 {
74   uint32_t result;
75
76   __ASM volatile ("MRS %0, control" : "=r" (result) );
77   return(result);
78 }
79
80
81 #if  (__ARM_FEATURE_CMSE == 3U)
82 /**
83   \brief   Get Control Register (non-secure)
84   \details Returns the content of the non-secure Control Register when in secure mode.
85   \return               non-secure Control Register value
86  */
87 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_CONTROL_NS(void)
88 {
89   uint32_t result;
90
91   __ASM volatile ("MRS %0, control_ns" : "=r" (result) );
92   return(result);
93 }
94 #endif
95
96
97 /**
98   \brief   Set Control Register
99   \details Writes the given value to the Control Register.
100   \param [in]    control  Control Register value to set
101  */
102 __attribute__((always_inline)) __STATIC_INLINE void __set_CONTROL(uint32_t control)
103 {
104   __ASM volatile ("MSR control, %0" : : "r" (control) : "memory");
105 }
106
107
108 #if  (__ARM_FEATURE_CMSE == 3U)
109 /**
110   \brief   Set Control Register (non-secure)
111   \details Writes the given value to the non-secure Control Register when in secure state.
112   \param [in]    control  Control Register value to set
113  */
114 __attribute__((always_inline)) __STATIC_INLINE void __TZ_set_CONTROL_NS(uint32_t control)
115 {
116   __ASM volatile ("MSR control_ns, %0" : : "r" (control) : "memory");
117 }
118 #endif
119
120
121 /**
122   \brief   Get IPSR Register
123   \details Returns the content of the IPSR Register.
124   \return               IPSR Register value
125  */
126 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_IPSR(void)
127 {
128   uint32_t result;
129
130   __ASM volatile ("MRS %0, ipsr" : "=r" (result) );
131   return(result);
132 }
133
134
135 #if  (__ARM_FEATURE_CMSE == 3U)
136 /**
137   \brief   Get IPSR Register (non-secure)
138   \details Returns the content of the non-secure IPSR Register when in secure state.
139   \return               IPSR Register value
140  */
141 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_IPSR_NS(void)
142 {
143   uint32_t result;
144
145   __ASM volatile ("MRS %0, ipsr_ns" : "=r" (result) );
146   return(result);
147 }
148 #endif
149
150
151 /**
152   \brief   Get APSR Register
153   \details Returns the content of the APSR Register.
154   \return               APSR Register value
155  */
156 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_APSR(void)
157 {
158   uint32_t result;
159
160   __ASM volatile ("MRS %0, apsr" : "=r" (result) );
161   return(result);
162 }
163
164
165 #if  (__ARM_FEATURE_CMSE == 3U)
166 /**
167   \brief   Get APSR Register (non-secure)
168   \details Returns the content of the non-secure APSR Register when in secure state.
169   \return               APSR Register value
170  */
171 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_APSR_NS(void)
172 {
173   uint32_t result;
174
175   __ASM volatile ("MRS %0, apsr_ns" : "=r" (result) );
176   return(result);
177 }
178 #endif
179
180
181 /**
182   \brief   Get xPSR Register
183   \details Returns the content of the xPSR Register.
184   \return               xPSR Register value
185  */
186 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_xPSR(void)
187 {
188   uint32_t result;
189
190   __ASM volatile ("MRS %0, xpsr" : "=r" (result) );
191   return(result);
192 }
193
194
195 #if  (__ARM_FEATURE_CMSE == 3U)
196 /**
197   \brief   Get xPSR Register (non-secure)
198   \details Returns the content of the non-secure xPSR Register when in secure state.
199   \return               xPSR Register value
200  */
201 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_xPSR_NS(void)
202 {
203   uint32_t result;
204
205   __ASM volatile ("MRS %0, xpsr_ns" : "=r" (result) );
206   return(result);
207 }
208 #endif
209
210
211 /**
212   \brief   Get Process Stack Pointer
213   \details Returns the current value of the Process Stack Pointer (PSP).
214   \return               PSP Register value
215  */
216 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_PSP(void)
217 {
218   register uint32_t result;
219
220   __ASM volatile ("MRS %0, psp"  : "=r" (result) );
221   return(result);
222 }
223
224
225 #if  (__ARM_FEATURE_CMSE == 3U)
226 /**
227   \brief   Get Process Stack Pointer (non-secure)
228   \details Returns the current value of the non-secure Process Stack Pointer (PSP) when in secure state.
229   \return               PSP Register value
230  */
231 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_PSP_NS(void)
232 {
233   register uint32_t result;
234
235   __ASM volatile ("MRS %0, psp_ns"  : "=r" (result) );
236   return(result);
237 }
238 #endif
239
240
241 /**
242   \brief   Set Process Stack Pointer
243   \details Assigns the given value to the Process Stack Pointer (PSP).
244   \param [in]    topOfProcStack  Process Stack Pointer value to set
245  */
246 __attribute__((always_inline)) __STATIC_INLINE void __set_PSP(uint32_t topOfProcStack)
247 {
248   __ASM volatile ("MSR psp, %0" : : "r" (topOfProcStack) : "sp");
249 }
250
251
252 #if  (__ARM_FEATURE_CMSE == 3U)
253 /**
254   \brief   Set Process Stack Pointer (non-secure)
255   \details Assigns the given value to the non-secure Process Stack Pointer (PSP) when in secure state.
256   \param [in]    topOfProcStack  Process Stack Pointer value to set
257  */
258 __attribute__((always_inline)) __STATIC_INLINE void __TZ_set_PSP_NS(uint32_t topOfProcStack)
259 {
260   __ASM volatile ("MSR psp_ns, %0" : : "r" (topOfProcStack) : "sp");
261 }
262 #endif
263
264
265 /**
266   \brief   Get Main Stack Pointer
267   \details Returns the current value of the Main Stack Pointer (MSP).
268   \return               MSP Register value
269  */
270 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_MSP(void)
271 {
272   register uint32_t result;
273
274   __ASM volatile ("MRS %0, msp" : "=r" (result) );
275   return(result);
276 }
277
278
279 #if  (__ARM_FEATURE_CMSE == 3U)
280 /**
281   \brief   Get Main Stack Pointer (non-secure)
282   \details Returns the current value of the non-secure Main Stack Pointer (MSP) when in secure state.
283   \return               MSP Register value
284  */
285 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_MSP_NS(void)
286 {
287   register uint32_t result;
288
289   __ASM volatile ("MRS %0, msp_ns" : "=r" (result) );
290   return(result);
291 }
292 #endif
293
294
295 /**
296   \brief   Set Main Stack Pointer
297   \details Assigns the given value to the Main Stack Pointer (MSP).
298   \param [in]    topOfMainStack  Main Stack Pointer value to set
299  */
300 __attribute__((always_inline)) __STATIC_INLINE void __set_MSP(uint32_t topOfMainStack)
301 {
302   __ASM volatile ("MSR msp, %0" : : "r" (topOfMainStack) : "sp");
303 }
304
305
306 #if  (__ARM_FEATURE_CMSE == 3U)
307 /**
308   \brief   Set Main Stack Pointer (non-secure)
309   \details Assigns the given value to the non-secure Main Stack Pointer (MSP) when in secure state.
310   \param [in]    topOfMainStack  Main Stack Pointer value to set
311  */
312 __attribute__((always_inline)) __STATIC_INLINE void __TZ_set_MSP_NS(uint32_t topOfMainStack)
313 {
314   __ASM volatile ("MSR msp_ns, %0" : : "r" (topOfMainStack) : "sp");
315 }
316 #endif
317
318
319 /**
320   \brief   Get Priority Mask
321   \details Returns the current state of the priority mask bit from the Priority Mask Register.
322   \return               Priority Mask value
323  */
324 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_PRIMASK(void)
325 {
326   uint32_t result;
327
328   __ASM volatile ("MRS %0, primask" : "=r" (result) );
329   return(result);
330 }
331
332
333 #if  (__ARM_FEATURE_CMSE == 3U)
334 /**
335   \brief   Get Priority Mask (non-secure)
336   \details Returns the current state of the non-secure priority mask bit from the Priority Mask Register when in secure state.
337   \return               Priority Mask value
338  */
339 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_PRIMASK_NS(void)
340 {
341   uint32_t result;
342
343   __ASM volatile ("MRS %0, primask_ns" : "=r" (result) );
344   return(result);
345 }
346 #endif
347
348
349 /**
350   \brief   Set Priority Mask
351   \details Assigns the given value to the Priority Mask Register.
352   \param [in]    priMask  Priority Mask
353  */
354 __attribute__((always_inline)) __STATIC_INLINE void __set_PRIMASK(uint32_t priMask)
355 {
356   __ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
357 }
358
359
360 #if  (__ARM_FEATURE_CMSE == 3U)
361 /**
362   \brief   Set Priority Mask (non-secure)
363   \details Assigns the given value to the non-secure Priority Mask Register when in secure state.
364   \param [in]    priMask  Priority Mask
365  */
366 __attribute__((always_inline)) __STATIC_INLINE void __TZ_set_PRIMASK_NS(uint32_t priMask)
367 {
368   __ASM volatile ("MSR primask_ns, %0" : : "r" (priMask) : "memory");
369 }
370 #endif
371
372
373 #if ((__ARM_ARCH_7M__ == 1U) || (__ARM_ARCH_7EM__ == 1U) || (__ARM_ARCH_8M__ == 1U))  /* ToDo:  ARMCC_V6: check if this is ok for cortex >=3 */
374
375 /**
376   \brief   Enable FIQ
377   \details Enables FIQ interrupts by clearing the F-bit in the CPSR.
378            Can only be executed in Privileged modes.
379  */
380 __attribute__((always_inline)) __STATIC_INLINE void __enable_fault_irq(void)
381 {
382   __ASM volatile ("cpsie f" : : : "memory");
383 }
384
385
386 /**
387   \brief   Disable FIQ
388   \details Disables FIQ interrupts by setting the F-bit in the CPSR.
389            Can only be executed in Privileged modes.
390  */
391 __attribute__((always_inline)) __STATIC_INLINE void __disable_fault_irq(void)
392 {
393   __ASM volatile ("cpsid f" : : : "memory");
394 }
395
396
397 /**
398   \brief   Get Base Priority
399   \details Returns the current value of the Base Priority register.
400   \return               Base Priority register value
401  */
402 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_BASEPRI(void)
403 {
404   uint32_t result;
405
406   __ASM volatile ("MRS %0, basepri" : "=r" (result) );
407   return(result);
408 }
409
410
411 #if  (__ARM_FEATURE_CMSE == 3U)
412 /**
413   \brief   Get Base Priority (non-secure)
414   \details Returns the current value of the non-secure Base Priority register when in secure state.
415   \return               Base Priority register value
416  */
417 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_BASEPRI_NS(void)
418 {
419   uint32_t result;
420
421   __ASM volatile ("MRS %0, basepri_ns" : "=r" (result) );
422   return(result);
423 }
424 #endif
425
426
427 /**
428   \brief   Set Base Priority
429   \details Assigns the given value to the Base Priority register.
430   \param [in]    basePri  Base Priority value to set
431  */
432 __attribute__((always_inline)) __STATIC_INLINE void __set_BASEPRI(uint32_t value)
433 {
434   __ASM volatile ("MSR basepri, %0" : : "r" (value) : "memory");
435 }
436
437
438 #if  (__ARM_FEATURE_CMSE == 3U)
439 /**
440   \brief   Set Base Priority (non-secure)
441   \details Assigns the given value to the non-secure Base Priority register when in secure state.
442   \param [in]    basePri  Base Priority value to set
443  */
444 __attribute__((always_inline)) __STATIC_INLINE void __TZ_set_BASEPRI_NS(uint32_t value)
445 {
446   __ASM volatile ("MSR basepri_ns, %0" : : "r" (value) : "memory");
447 }
448 #endif
449
450
451 /**
452   \brief   Set Base Priority with condition
453   \details Assigns the given value to the Base Priority register only if BASEPRI masking is disabled,
454            or the new value increases the BASEPRI priority level.
455   \param [in]    basePri  Base Priority value to set
456  */
457 __attribute__((always_inline)) __STATIC_INLINE void __set_BASEPRI_MAX(uint32_t value)
458 {
459   __ASM volatile ("MSR basepri_max, %0" : : "r" (value) : "memory");
460 }
461
462
463 #if  (__ARM_FEATURE_CMSE == 3U)
464 /**
465   \brief   Set Base Priority with condition (non_secure)
466   \details Assigns the given value to the non-secure Base Priority register when in secure state only if BASEPRI masking is disabled,
467            or the new value increases the BASEPRI priority level.
468   \param [in]    basePri  Base Priority value to set
469  */
470 __attribute__((always_inline)) __STATIC_INLINE void __TZ_set_BASEPRI_MAX_NS(uint32_t value)
471 {
472   __ASM volatile ("MSR basepri_max_ns, %0" : : "r" (value) : "memory");
473 }
474 #endif
475
476
477 /**
478   \brief   Get Fault Mask
479   \details Returns the current value of the Fault Mask register.
480   \return               Fault Mask register value
481  */
482 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_FAULTMASK(void)
483 {
484   uint32_t result;
485
486   __ASM volatile ("MRS %0, faultmask" : "=r" (result) );
487   return(result);
488 }
489
490
491 #if  (__ARM_FEATURE_CMSE == 3U)
492 /**
493   \brief   Get Fault Mask (non-secure)
494   \details Returns the current value of the non-secure Fault Mask register when in secure state.
495   \return               Fault Mask register value
496  */
497 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_FAULTMASK_NS(void)
498 {
499   uint32_t result;
500
501   __ASM volatile ("MRS %0, faultmask_ns" : "=r" (result) );
502   return(result);
503 }
504 #endif
505
506
507 /**
508   \brief   Set Fault Mask
509   \details Assigns the given value to the Fault Mask register.
510   \param [in]    faultMask  Fault Mask value to set
511  */
512 __attribute__((always_inline)) __STATIC_INLINE void __set_FAULTMASK(uint32_t faultMask)
513 {
514   __ASM volatile ("MSR faultmask, %0" : : "r" (faultMask) : "memory");
515 }
516
517
518 #if  (__ARM_FEATURE_CMSE == 3U)
519 /**
520   \brief   Set Fault Mask (non-secure)
521   \details Assigns the given value to the non-secure Fault Mask register when in secure state.
522   \param [in]    faultMask  Fault Mask value to set
523  */
524 __attribute__((always_inline)) __STATIC_INLINE void __TZ_set_FAULTMASK_NS(uint32_t faultMask)
525 {
526   __ASM volatile ("MSR faultmask_ns, %0" : : "r" (faultMask) : "memory");
527 }
528 #endif
529
530
531 #endif /* ((__ARM_ARCH_7M__ == 1U) || (__ARM_ARCH_8M__ == 1U)) */
532
533
534 #if (__ARM_ARCH_8M__ == 1U)
535
536 /**
537   \brief   Get Process Stack Pointer Limit
538   \details Returns the current value of the Process Stack Pointer Limit (PSPLIM).
539   \return               PSPLIM Register value
540  */
541 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_PSPLIM(void)
542 {
543   register uint32_t result;
544
545   __ASM volatile ("MRS %0, psplim"  : "=r" (result) );
546   return(result);
547 }
548
549
550 #if  (__ARM_FEATURE_CMSE == 3U) && (__ARM_ARCH_PROFILE == 'M')     /* ToDo:  ARMCC_V6: check predefined macro for mainline */
551 /**
552   \brief   Get Process Stack Pointer Limit (non-secure)
553   \details Returns the current value of the non-secure Process Stack Pointer Limit (PSPLIM) when in secure state.
554   \return               PSPLIM Register value
555  */
556 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_PSPLIM_NS(void)
557 {
558   register uint32_t result;
559
560   __ASM volatile ("MRS %0, psplim_ns"  : "=r" (result) );
561   return(result);
562 }
563 #endif
564
565
566 /**
567   \brief   Set Process Stack Pointer Limit
568   \details Assigns the given value to the Process Stack Pointer Limit (PSPLIM).
569   \param [in]    ProcStackPtrLimit  Process Stack Pointer Limit value to set
570  */
571 __attribute__((always_inline)) __STATIC_INLINE void __set_PSPLIM(uint32_t ProcStackPtrLimit)
572 {
573   __ASM volatile ("MSR psplim, %0" : : "r" (ProcStackPtrLimit));
574 }
575
576
577 #if  (__ARM_FEATURE_CMSE == 3U) && (__ARM_ARCH_PROFILE == 'M')     /* ToDo:  ARMCC_V6: check predefined macro for mainline */
578 /**
579   \brief   Set Process Stack Pointer (non-secure)
580   \details Assigns the given value to the non-secure Process Stack Pointer Limit (PSPLIM) when in secure state.
581   \param [in]    ProcStackPtrLimit  Process Stack Pointer Limit value to set
582  */
583 __attribute__((always_inline)) __STATIC_INLINE void __TZ_set_PSPLIM_NS(uint32_t ProcStackPtrLimit)
584 {
585   __ASM volatile ("MSR psplim_ns, %0\n" : : "r" (ProcStackPtrLimit));
586 }
587 #endif
588
589
590 /**
591   \brief   Get Main Stack Pointer Limit
592   \details Returns the current value of the Main Stack Pointer Limit (MSPLIM).
593   \return               MSPLIM Register value
594  */
595 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_MSPLIM(void)
596 {
597   register uint32_t result;
598
599   __ASM volatile ("MRS %0, msplim" : "=r" (result) );
600
601   return(result);
602 }
603
604
605 #if  (__ARM_FEATURE_CMSE == 3U) && (__ARM_ARCH_PROFILE == 'M')     /* ToDo:  ARMCC_V6: check predefined macro for mainline */
606 /**
607   \brief   Get Main Stack Pointer Limit (non-secure)
608   \details Returns the current value of the non-secure Main Stack Pointer Limit(MSPLIM) when in secure state.
609   \return               MSPLIM Register value
610  */
611 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_MSPLIM_NS(void)
612 {
613   register uint32_t result;
614
615   __ASM volatile ("MRS %0, msplim_ns" : "=r" (result) );
616   return(result);
617 }
618 #endif
619
620
621 /**
622   \brief   Set Main Stack Pointer Limit
623   \details Assigns the given value to the Main Stack Pointer Limit (MSPLIM).
624   \param [in]    MainStackPtrLimit  Main Stack Pointer Limit value to set
625  */
626 __attribute__((always_inline)) __STATIC_INLINE void __set_MSPLIM(uint32_t MainStackPtrLimit)
627 {
628   __ASM volatile ("MSR msplim, %0" : : "r" (MainStackPtrLimit));
629 }
630
631
632 #if  (__ARM_FEATURE_CMSE == 3U) && (__ARM_ARCH_PROFILE == 'M')     /* ToDo:  ARMCC_V6: check predefined macro for mainline */
633 /**
634   \brief   Set Main Stack Pointer Limit (non-secure)
635   \details Assigns the given value to the non-secure Main Stack Pointer Limit (MSPLIM) when in secure state.
636   \param [in]    MainStackPtrLimit  Main Stack Pointer value to set
637  */
638 __attribute__((always_inline)) __STATIC_INLINE void __TZ_set_MSPLIM_NS(uint32_t MainStackPtrLimit)
639 {
640   __ASM volatile ("MSR msplim_ns, %0" : : "r" (MainStackPtrLimit));
641 }
642 #endif
643
644 #endif /* (__ARM_ARCH_8M__ == 1U) */
645
646
647 #if ((__ARM_ARCH_7EM__ == 1U) || (__ARM_ARCH_8M__ == 1U))  /* ToDo:  ARMCC_V6: check if this is ok for cortex >=4 */
648
649 /**
650   \brief   Get FPSCR
651   \details eturns the current value of the Floating Point Status/Control register.
652   \return               Floating Point Status/Control register value
653  */
654 #define __get_FPSCR      __builtin_arm_get_fpscr
655 #if 0
656 __attribute__((always_inline)) __STATIC_INLINE uint32_t __get_FPSCR(void)
657 {
658 #if (__FPU_PRESENT == 1U) && (__FPU_USED == 1U)
659   uint32_t result;
660
661   __ASM volatile ("");                                 /* Empty asm statement works as a scheduling barrier */
662   __ASM volatile ("VMRS %0, fpscr" : "=r" (result) );
663   __ASM volatile ("");
664   return(result);
665 #else
666    return(0);
667 #endif
668 }
669 #endif
670
671 #if  (__ARM_FEATURE_CMSE == 3U)
672 /**
673   \brief   Get FPSCR (non-secure)
674   \details Returns the current value of the non-secure Floating Point Status/Control register when in secure state.
675   \return               Floating Point Status/Control register value
676  */
677 __attribute__((always_inline)) __STATIC_INLINE uint32_t __TZ_get_FPSCR_NS(void)
678 {
679 #if (__FPU_PRESENT == 1U) && (__FPU_USED == 1U)
680   uint32_t result;
681
682   __ASM volatile ("");                                 /* Empty asm statement works as a scheduling barrier */
683   __ASM volatile ("VMRS %0, fpscr_ns" : "=r" (result) );
684   __ASM volatile ("");
685   return(result);
686 #else
687    return(0);
688 #endif
689 }
690 #endif
691
692
693 /**
694   \brief   Set FPSCR
695   \details Assigns the given value to the Floating Point Status/Control register.
696   \param [in]    fpscr  Floating Point Status/Control value to set
697  */
698 #define __set_FPSCR      __builtin_arm_set_fpscr
699 #if 0
700 __attribute__((always_inline)) __STATIC_INLINE void __set_FPSCR(uint32_t fpscr)
701 {
702 #if (__FPU_PRESENT == 1U) && (__FPU_USED == 1U)
703   __ASM volatile ("");                                 /* Empty asm statement works as a scheduling barrier */
704   __ASM volatile ("VMSR fpscr, %0" : : "r" (fpscr) : "vfpcc");
705   __ASM volatile ("");
706 #endif
707 }
708 #endif
709
710 #if  (__ARM_FEATURE_CMSE == 3U)
711 /**
712   \brief   Set FPSCR (non-secure)
713   \details Assigns the given value to the non-secure Floating Point Status/Control register when in secure state.
714   \param [in]    fpscr  Floating Point Status/Control value to set
715  */
716 __attribute__((always_inline)) __STATIC_INLINE void __TZ_set_FPSCR_NS(uint32_t fpscr)
717 {
718 #if (__FPU_PRESENT == 1U) && (__FPU_USED == 1U)
719   __ASM volatile ("");                                 /* Empty asm statement works as a scheduling barrier */
720   __ASM volatile ("VMSR fpscr_ns, %0" : : "r" (fpscr) : "vfpcc");
721   __ASM volatile ("");
722 #endif
723 }
724 #endif
725
726 #endif /* ((__ARM_ARCH_7EM__ == 1U) || (__ARM_ARCH_8M__ == 1U)) */
727
728
729
730 /*@} end of CMSIS_Core_RegAccFunctions */
731
732
733 /* ##########################  Core Instruction Access  ######################### */
734 /** \defgroup CMSIS_Core_InstructionInterface CMSIS Core Instruction Interface
735   Access to dedicated instructions
736   @{
737 */
738
739 /* Define macros for porting to both thumb1 and thumb2.
740  * For thumb1, use low register (r0-r7), specified by constraint "l"
741  * Otherwise, use general registers, specified by constraint "r" */
742 #if defined (__thumb__) && !defined (__thumb2__)
743 #define __CMSIS_GCC_OUT_REG(r) "=l" (r)
744 #define __CMSIS_GCC_USE_REG(r) "l" (r)
745 #else
746 #define __CMSIS_GCC_OUT_REG(r) "=r" (r)
747 #define __CMSIS_GCC_USE_REG(r) "r" (r)
748 #endif
749
750 /**
751   \brief   No Operation
752   \details No Operation does nothing. This instruction can be used for code alignment purposes.
753  */
754 #define __NOP          __builtin_arm_nop
755
756 /**
757   \brief   Wait For Interrupt
758   \details Wait For Interrupt is a hint instruction that suspends execution until one of a number of events occurs.
759  */
760 #define __WFI          __builtin_arm_wfi
761
762
763 /**
764   \brief   Wait For Event
765   \details Wait For Event is a hint instruction that permits the processor to enter
766            a low-power state until one of a number of events occurs.
767  */
768 #define __WFE          __builtin_arm_wfe
769
770
771 /**
772   \brief   Send Event
773   \details Send Event is a hint instruction. It causes an event to be signaled to the CPU.
774  */
775 #define __SEV          __builtin_arm_sev
776
777
778 /**
779   \brief   Instruction Synchronization Barrier
780   \details Instruction Synchronization Barrier flushes the pipeline in the processor,
781            so that all instructions following the ISB are fetched from cache or memory,
782            after the instruction has been completed.
783  */
784 #define __ISB()        __builtin_arm_isb(0xF);
785
786 /**
787   \brief   Data Synchronization Barrier
788   \details Acts as a special kind of Data Memory Barrier.
789            It completes when all explicit memory accesses before this instruction complete.
790  */
791 #define __DSB()        __builtin_arm_dsb(0xF);
792
793
794 /**
795   \brief   Data Memory Barrier
796   \details Ensures the apparent order of the explicit memory operations before
797            and after the instruction, without ensuring their completion.
798  */
799 #define __DMB()        __builtin_arm_dmb(0xF);
800
801
802 /**
803   \brief   Reverse byte order (32 bit)
804   \details Reverses the byte order in integer value.
805   \param [in]    value  Value to reverse
806   \return               Reversed value
807  */
808 #define __REV          __builtin_bswap32
809
810
811 /**
812   \brief   Reverse byte order (16 bit)
813   \details Reverses the byte order in two unsigned short values.
814   \param [in]    value  Value to reverse
815   \return               Reversed value
816  */
817 #define __REV16          __builtin_bswap16                           /* ToDo:  ARMCC_V6: check if __builtin_bswap16 could be used */
818 #if 0
819 __attribute__((always_inline)) __STATIC_INLINE uint32_t __REV16(uint32_t value)
820 {
821   uint32_t result;
822
823   __ASM volatile ("rev16 %0, %1" : __CMSIS_GCC_OUT_REG (result) : __CMSIS_GCC_USE_REG (value) );
824   return(result);
825 }
826 #endif
827
828
829 /**
830   \brief   Reverse byte order in signed short value
831   \details Reverses the byte order in a signed short value with sign extension to integer.
832   \param [in]    value  Value to reverse
833   \return               Reversed value
834  */
835                                                           /* ToDo:  ARMCC_V6: check if __builtin_bswap16 could be used */
836 __attribute__((always_inline)) __STATIC_INLINE int32_t __REVSH(int32_t value)
837 {
838   int32_t result;
839
840   __ASM volatile ("revsh %0, %1" : __CMSIS_GCC_OUT_REG (result) : __CMSIS_GCC_USE_REG (value) );
841   return(result);
842 }
843
844
845 /**
846   \brief   Rotate Right in unsigned value (32 bit)
847   \details Rotate Right (immediate) provides the value of the contents of a register rotated by a variable number of bits.
848   \param [in]    op1  Value to rotate
849   \param [in]    op2  Number of Bits to rotate
850   \return               Rotated value
851  */
852 __attribute__((always_inline)) __STATIC_INLINE uint32_t __ROR(uint32_t op1, uint32_t op2)
853 {
854   return (op1 >> op2) | (op1 << (32U - op2));
855 }
856
857
858 /**
859   \brief   Breakpoint
860   \details Causes the processor to enter Debug state.
861             Debug tools can use this to investigate system state when the instruction at a particular address is reached.
862     \param [in]    value  is ignored by the processor.
863                    If required, a debugger can use it to store additional information about the breakpoint.
864  */
865 #define __BKPT(value)                       __ASM volatile ("bkpt "#value)
866
867
868 /**
869   \brief   Reverse bit order of value
870   \details Reverses the bit order of the given value.
871   \param [in]    value  Value to reverse
872   \return               Reversed value
873  */
874                                                           /* ToDo:  ARMCC_V6: check if __builtin_arm_rbit is supported */
875 __attribute__((always_inline)) __STATIC_INLINE uint32_t __RBIT(uint32_t value)
876 {
877   uint32_t result;
878
879 #if ((__ARM_ARCH_7M__ == 1U) || (__ARM_ARCH_7EM__ == 1U) || (__ARM_ARCH_8M__ == 1U))  /* ToDo:  ARMCC_V6: check if this is ok for cortex >=3 */
880    __ASM volatile ("rbit %0, %1" : "=r" (result) : "r" (value) );
881 #else
882   int32_t s = 4 /*sizeof(v)*/ * 8 - 1; /* extra shift needed at end */
883
884   result = value;                      /* r will be reversed bits of v; first get LSB of v */
885   for (value >>= 1U; value; value >>= 1U)
886   {
887     result <<= 1U;
888     result |= value & 1U;
889     s--;
890   }
891   result <<= s;                        /* shift when v's highest bits are zero */
892 #endif
893   return(result);
894 }
895
896
897 /**
898   \brief   Count leading zeros
899   \details Counts the number of leading zeros of a data value.
900   \param [in]  value  Value to count the leading zeros
901   \return             number of leading zeros in value
902  */
903 #define __CLZ             __builtin_clz
904
905
906 #if ((__ARM_ARCH_7M__ == 1U) || (__ARM_ARCH_7EM__ == 1U) || (__ARM_ARCH_8M__ == 1U))  /* ToDo:  ARMCC_V6: check if this is ok for cortex >=3 */
907
908 /**
909   \brief   LDR Exclusive (8 bit)
910   \details Executes a exclusive LDR instruction for 8 bit value.
911   \param [in]    ptr  Pointer to data
912   \return             value of type uint8_t at (*ptr)
913  */
914 #define __LDREXB        (uint8_t)__builtin_arm_ldrex
915
916
917 /**
918   \brief   LDR Exclusive (16 bit)
919   \details Executes a exclusive LDR instruction for 16 bit values.
920   \param [in]    ptr  Pointer to data
921   \return        value of type uint16_t at (*ptr)
922  */
923 #define __LDREXH        (uint16_t)__builtin_arm_ldrex
924
925
926 /**
927   \brief   LDR Exclusive (32 bit)
928   \details Executes a exclusive LDR instruction for 32 bit values.
929   \param [in]    ptr  Pointer to data
930   \return        value of type uint32_t at (*ptr)
931  */
932 #define __LDREXW        (uint32_t)__builtin_arm_ldrex
933
934
935 /**
936   \brief   STR Exclusive (8 bit)
937   \details Executes a exclusive STR instruction for 8 bit values.
938   \param [in]  value  Value to store
939   \param [in]    ptr  Pointer to location
940   \return          0  Function succeeded
941   \return          1  Function failed
942  */
943 #define __STREXB        (uint32_t)__builtin_arm_strex
944
945
946 /**
947   \brief   STR Exclusive (16 bit)
948   \details Executes a exclusive STR instruction for 16 bit values.
949   \param [in]  value  Value to store
950   \param [in]    ptr  Pointer to location
951   \return          0  Function succeeded
952   \return          1  Function failed
953  */
954 #define __STREXH        (uint32_t)__builtin_arm_strex
955
956
957 /**
958   \brief   STR Exclusive (32 bit)
959   \details Executes a exclusive STR instruction for 32 bit values.
960   \param [in]  value  Value to store
961   \param [in]    ptr  Pointer to location
962   \return          0  Function succeeded
963   \return          1  Function failed
964  */
965 #define __STREXW        (uint32_t)__builtin_arm_strex
966
967
968 /**
969   \brief   Remove the exclusive lock
970   \details Removes the exclusive lock which is created by LDREX.
971  */
972 #define __CLREX             __builtin_arm_clrex
973
974
975 /**
976   \brief   Signed Saturate
977   \details Saturates a signed value.
978   \param [in]  value  Value to be saturated
979   \param [in]    sat  Bit position to saturate to (1..32)
980   \return             Saturated value
981  */
982 /*#define __SSAT             __builtin_arm_ssat*/
983 #define __SSAT(ARG1,ARG2) \
984 ({                          \
985   int32_t __RES, __ARG1 = (ARG1); \
986   __ASM ("ssat %0, %1, %2" : "=r" (__RES) :  "I" (ARG2), "r" (__ARG1) ); \
987   __RES; \
988  })
989
990
991 /**
992   \brief   Unsigned Saturate
993   \details Saturates an unsigned value.
994   \param [in]  value  Value to be saturated
995   \param [in]    sat  Bit position to saturate to (0..31)
996   \return             Saturated value
997  */
998 #define __USAT             __builtin_arm_usat
999 #if 0
1000 #define __USAT(ARG1,ARG2) \
1001 ({                          \
1002   uint32_t __RES, __ARG1 = (ARG1); \
1003   __ASM ("usat %0, %1, %2" : "=r" (__RES) :  "I" (ARG2), "r" (__ARG1) ); \
1004   __RES; \
1005  })
1006 #endif
1007
1008
1009 /**
1010   \brief   Rotate Right with Extend (32 bit)
1011   \details Moves each bit of a bitstring right by one bit.
1012            The carry input is shifted in at the left end of the bitstring.
1013   \param [in]    value  Value to rotate
1014   \return               Rotated value
1015  */
1016 __attribute__((always_inline)) __STATIC_INLINE uint32_t __RRX(uint32_t value)
1017 {
1018   uint32_t result;
1019
1020   __ASM volatile ("rrx %0, %1" : __CMSIS_GCC_OUT_REG (result) : __CMSIS_GCC_USE_REG (value) );
1021   return(result);
1022 }
1023
1024
1025 /**
1026   \brief   LDRT Unprivileged (8 bit)
1027   \details Executes a Unprivileged LDRT instruction for 8 bit value.
1028   \param [in]    ptr  Pointer to data
1029   \return             value of type uint8_t at (*ptr)
1030  */
1031 __attribute__((always_inline)) __STATIC_INLINE uint8_t __LDRBT(volatile uint8_t *ptr)
1032 {
1033     uint32_t result;
1034
1035    __ASM volatile ("ldrbt %0, %1" : "=r" (result) : "Q" (*ptr) );
1036    return ((uint8_t) result);    /* Add explicit type cast here */
1037 }
1038
1039
1040 /**
1041   \brief   LDRT Unprivileged (16 bit)
1042   \details Executes a Unprivileged LDRT instruction for 16 bit values.
1043   \param [in]    ptr  Pointer to data
1044   \return        value of type uint16_t at (*ptr)
1045  */
1046 __attribute__((always_inline)) __STATIC_INLINE uint16_t __LDRHT(volatile uint16_t *ptr)
1047 {
1048     uint32_t result;
1049
1050    __ASM volatile ("ldrht %0, %1" : "=r" (result) : "Q" (*ptr) );
1051    return ((uint16_t) result);    /* Add explicit type cast here */
1052 }
1053
1054
1055 /**
1056   \brief   LDRT Unprivileged (32 bit)
1057   \details Executes a Unprivileged LDRT instruction for 32 bit values.
1058   \param [in]    ptr  Pointer to data
1059   \return        value of type uint32_t at (*ptr)
1060  */
1061 __attribute__((always_inline)) __STATIC_INLINE uint32_t __LDRT(volatile uint32_t *ptr)
1062 {
1063     uint32_t result;
1064
1065    __ASM volatile ("ldrt %0, %1" : "=r" (result) : "Q" (*ptr) );
1066    return(result);
1067 }
1068
1069
1070 /**
1071   \brief   STRT Unprivileged (8 bit)
1072   \details Executes a Unprivileged STRT instruction for 8 bit values.
1073   \param [in]  value  Value to store
1074   \param [in]    ptr  Pointer to location
1075  */
1076 __attribute__((always_inline)) __STATIC_INLINE void __STRBT(uint8_t value, volatile uint8_t *ptr)
1077 {
1078    __ASM volatile ("strbt %1, %0" : "=Q" (*ptr) : "r" ((uint32_t)value) );
1079 }
1080
1081
1082 /**
1083   \brief   STRT Unprivileged (16 bit)
1084   \details Executes a Unprivileged STRT instruction for 16 bit values.
1085   \param [in]  value  Value to store
1086   \param [in]    ptr  Pointer to location
1087  */
1088 __attribute__((always_inline)) __STATIC_INLINE void __STRHT(uint16_t value, volatile uint16_t *ptr)
1089 {
1090    __ASM volatile ("strht %1, %0" : "=Q" (*ptr) : "r" ((uint32_t)value) );
1091 }
1092
1093
1094 /**
1095   \brief   STRT Unprivileged (32 bit)
1096   \details Executes a Unprivileged STRT instruction for 32 bit values.
1097   \param [in]  value  Value to store
1098   \param [in]    ptr  Pointer to location
1099  */
1100 __attribute__((always_inline)) __STATIC_INLINE void __STRT(uint32_t value, volatile uint32_t *ptr)
1101 {
1102    __ASM volatile ("strt %1, %0" : "=Q" (*ptr) : "r" (value) );
1103 }
1104
1105 #endif /* ((__ARM_ARCH_7M__ == 1U) || (__ARM_ARCH_7EM__ == 1U) || (__ARM_ARCH_8M__ == 1U)) */
1106
1107
1108 #if (__ARM_ARCH_8M__ == 1U)
1109
1110 /**
1111   \brief   Load-Acquire (8 bit)
1112   \details Executes a LDAB instruction for 8 bit value.
1113   \param [in]    ptr  Pointer to data
1114   \return             value of type uint8_t at (*ptr)
1115  */
1116 __attribute__((always_inline)) __STATIC_INLINE uint8_t __LDAB(volatile uint8_t *ptr)
1117 {
1118     uint32_t result;
1119
1120    __ASM volatile ("ldab %0, %1" : "=r" (result) : "Q" (*ptr) );
1121    return ((uint8_t) result);
1122 }
1123
1124
1125 /**
1126   \brief   Load-Acquire (16 bit)
1127   \details Executes a LDAH instruction for 16 bit values.
1128   \param [in]    ptr  Pointer to data
1129   \return        value of type uint16_t at (*ptr)
1130  */
1131 __attribute__((always_inline)) __STATIC_INLINE uint16_t __LDAH(volatile uint16_t *ptr)
1132 {
1133     uint32_t result;
1134
1135    __ASM volatile ("ldah %0, %1" : "=r" (result) : "Q" (*ptr) );
1136    return ((uint16_t) result);
1137 }
1138
1139
1140 /**
1141   \brief   Load-Acquire (32 bit)
1142   \details Executes a LDA instruction for 32 bit values.
1143   \param [in]    ptr  Pointer to data
1144   \return        value of type uint32_t at (*ptr)
1145  */
1146 __attribute__((always_inline)) __STATIC_INLINE uint32_t __LDA(volatile uint32_t *ptr)
1147 {
1148     uint32_t result;
1149
1150    __ASM volatile ("lda %0, %1" : "=r" (result) : "Q" (*ptr) );
1151    return(result);
1152 }
1153
1154
1155 /**
1156   \brief   Store-Release (8 bit)
1157   \details Executes a STLB instruction for 8 bit values.
1158   \param [in]  value  Value to store
1159   \param [in]    ptr  Pointer to location
1160  */
1161 __attribute__((always_inline)) __STATIC_INLINE void __STLB(uint8_t value, volatile uint8_t *ptr)
1162 {
1163    __ASM volatile ("stlb %1, %0" : "=Q" (*ptr) : "r" ((uint32_t)value) );
1164 }
1165
1166
1167 /**
1168   \brief   Store-Release (16 bit)
1169   \details Executes a STLH instruction for 16 bit values.
1170   \param [in]  value  Value to store
1171   \param [in]    ptr  Pointer to location
1172  */
1173 __attribute__((always_inline)) __STATIC_INLINE void __STLH(uint16_t value, volatile uint16_t *ptr)
1174 {
1175    __ASM volatile ("stlh %1, %0" : "=Q" (*ptr) : "r" ((uint32_t)value) );
1176 }
1177
1178
1179 /**
1180   \brief   Store-Release (32 bit)
1181   \details Executes a STL instruction for 32 bit values.
1182   \param [in]  value  Value to store
1183   \param [in]    ptr  Pointer to location
1184  */
1185 __attribute__((always_inline)) __STATIC_INLINE void __STL(uint32_t value, volatile uint32_t *ptr)
1186 {
1187    __ASM volatile ("stl %1, %0" : "=Q" (*ptr) : "r" ((uint32_t)value) );
1188 }
1189
1190
1191 /**
1192   \brief   Load-Acquire Exclusive (8 bit)
1193   \details Executes a LDAB exclusive instruction for 8 bit value.
1194   \param [in]    ptr  Pointer to data
1195   \return             value of type uint8_t at (*ptr)
1196  */
1197 #define     __LDAEXB                 (uint8_t)__builtin_arm_ldaex
1198
1199
1200 /**
1201   \brief   Load-Acquire Exclusive (16 bit)
1202   \details Executes a LDAH exclusive instruction for 16 bit values.
1203   \param [in]    ptr  Pointer to data
1204   \return        value of type uint16_t at (*ptr)
1205  */
1206 #define     __LDAEXH                 (uint16_t)__builtin_arm_ldaex
1207
1208
1209 /**
1210   \brief   Load-Acquire Exclusive (32 bit)
1211   \details Executes a LDA exclusive instruction for 32 bit values.
1212   \param [in]    ptr  Pointer to data
1213   \return        value of type uint32_t at (*ptr)
1214  */
1215 #define     __LDAEX                  (uint32_t)__builtin_arm_ldaex
1216
1217
1218 /**
1219   \brief   Store-Release Exclusive (8 bit)
1220   \details Executes a STLB exclusive instruction for 8 bit values.
1221   \param [in]  value  Value to store
1222   \param [in]    ptr  Pointer to location
1223   \return          0  Function succeeded
1224   \return          1  Function failed
1225  */
1226 #define     __STLEXB                 (uint32_t)__builtin_arm_stlex
1227
1228
1229 /**
1230   \brief   Store-Release Exclusive (16 bit)
1231   \details Executes a STLH exclusive instruction for 16 bit values.
1232   \param [in]  value  Value to store
1233   \param [in]    ptr  Pointer to location
1234   \return          0  Function succeeded
1235   \return          1  Function failed
1236  */
1237 #define     __STLEXH                 (uint32_t)__builtin_arm_stlex
1238
1239
1240 /**
1241   \brief   Store-Release Exclusive (32 bit)
1242   \details Executes a STL exclusive instruction for 32 bit values.
1243   \param [in]  value  Value to store
1244   \param [in]    ptr  Pointer to location
1245   \return          0  Function succeeded
1246   \return          1  Function failed
1247  */
1248 #define     __STLEX                  (uint32_t)__builtin_arm_stlex
1249
1250 #endif /* (__ARM_ARCH_8M__ == 1U) */
1251
1252 /*@}*/ /* end of group CMSIS_Core_InstructionInterface */
1253
1254
1255 /* ###################  Compiler specific Intrinsics  ########################### */
1256 /** \defgroup CMSIS_SIMD_intrinsics CMSIS SIMD Intrinsics
1257   Access to dedicated SIMD instructions
1258   @{
1259 */
1260
1261 #if (__ARM_FEATURE_DSP == 1U)        /* ToDo:  ARMCC_V6: This should be ARCH >= ARMv7-M + SIMD */
1262
1263 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SADD8(uint32_t op1, uint32_t op2)
1264 {
1265   uint32_t result;
1266
1267   __ASM volatile ("sadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1268   return(result);
1269 }
1270
1271 __attribute__((always_inline)) __STATIC_INLINE uint32_t __QADD8(uint32_t op1, uint32_t op2)
1272 {
1273   uint32_t result;
1274
1275   __ASM volatile ("qadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1276   return(result);
1277 }
1278
1279 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SHADD8(uint32_t op1, uint32_t op2)
1280 {
1281   uint32_t result;
1282
1283   __ASM volatile ("shadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1284   return(result);
1285 }
1286
1287 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UADD8(uint32_t op1, uint32_t op2)
1288 {
1289   uint32_t result;
1290
1291   __ASM volatile ("uadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1292   return(result);
1293 }
1294
1295 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UQADD8(uint32_t op1, uint32_t op2)
1296 {
1297   uint32_t result;
1298
1299   __ASM volatile ("uqadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1300   return(result);
1301 }
1302
1303 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UHADD8(uint32_t op1, uint32_t op2)
1304 {
1305   uint32_t result;
1306
1307   __ASM volatile ("uhadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1308   return(result);
1309 }
1310
1311
1312 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SSUB8(uint32_t op1, uint32_t op2)
1313 {
1314   uint32_t result;
1315
1316   __ASM volatile ("ssub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1317   return(result);
1318 }
1319
1320 __attribute__((always_inline)) __STATIC_INLINE uint32_t __QSUB8(uint32_t op1, uint32_t op2)
1321 {
1322   uint32_t result;
1323
1324   __ASM volatile ("qsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1325   return(result);
1326 }
1327
1328 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SHSUB8(uint32_t op1, uint32_t op2)
1329 {
1330   uint32_t result;
1331
1332   __ASM volatile ("shsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1333   return(result);
1334 }
1335
1336 __attribute__((always_inline)) __STATIC_INLINE uint32_t __USUB8(uint32_t op1, uint32_t op2)
1337 {
1338   uint32_t result;
1339
1340   __ASM volatile ("usub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1341   return(result);
1342 }
1343
1344 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UQSUB8(uint32_t op1, uint32_t op2)
1345 {
1346   uint32_t result;
1347
1348   __ASM volatile ("uqsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1349   return(result);
1350 }
1351
1352 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UHSUB8(uint32_t op1, uint32_t op2)
1353 {
1354   uint32_t result;
1355
1356   __ASM volatile ("uhsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1357   return(result);
1358 }
1359
1360
1361 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SADD16(uint32_t op1, uint32_t op2)
1362 {
1363   uint32_t result;
1364
1365   __ASM volatile ("sadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1366   return(result);
1367 }
1368
1369 __attribute__((always_inline)) __STATIC_INLINE uint32_t __QADD16(uint32_t op1, uint32_t op2)
1370 {
1371   uint32_t result;
1372
1373   __ASM volatile ("qadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1374   return(result);
1375 }
1376
1377 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SHADD16(uint32_t op1, uint32_t op2)
1378 {
1379   uint32_t result;
1380
1381   __ASM volatile ("shadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1382   return(result);
1383 }
1384
1385 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UADD16(uint32_t op1, uint32_t op2)
1386 {
1387   uint32_t result;
1388
1389   __ASM volatile ("uadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1390   return(result);
1391 }
1392
1393 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UQADD16(uint32_t op1, uint32_t op2)
1394 {
1395   uint32_t result;
1396
1397   __ASM volatile ("uqadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1398   return(result);
1399 }
1400
1401 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UHADD16(uint32_t op1, uint32_t op2)
1402 {
1403   uint32_t result;
1404
1405   __ASM volatile ("uhadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1406   return(result);
1407 }
1408
1409 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SSUB16(uint32_t op1, uint32_t op2)
1410 {
1411   uint32_t result;
1412
1413   __ASM volatile ("ssub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1414   return(result);
1415 }
1416
1417 __attribute__((always_inline)) __STATIC_INLINE uint32_t __QSUB16(uint32_t op1, uint32_t op2)
1418 {
1419   uint32_t result;
1420
1421   __ASM volatile ("qsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1422   return(result);
1423 }
1424
1425 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SHSUB16(uint32_t op1, uint32_t op2)
1426 {
1427   uint32_t result;
1428
1429   __ASM volatile ("shsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1430   return(result);
1431 }
1432
1433 __attribute__((always_inline)) __STATIC_INLINE uint32_t __USUB16(uint32_t op1, uint32_t op2)
1434 {
1435   uint32_t result;
1436
1437   __ASM volatile ("usub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1438   return(result);
1439 }
1440
1441 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UQSUB16(uint32_t op1, uint32_t op2)
1442 {
1443   uint32_t result;
1444
1445   __ASM volatile ("uqsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1446   return(result);
1447 }
1448
1449 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UHSUB16(uint32_t op1, uint32_t op2)
1450 {
1451   uint32_t result;
1452
1453   __ASM volatile ("uhsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1454   return(result);
1455 }
1456
1457 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SASX(uint32_t op1, uint32_t op2)
1458 {
1459   uint32_t result;
1460
1461   __ASM volatile ("sasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1462   return(result);
1463 }
1464
1465 __attribute__((always_inline)) __STATIC_INLINE uint32_t __QASX(uint32_t op1, uint32_t op2)
1466 {
1467   uint32_t result;
1468
1469   __ASM volatile ("qasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1470   return(result);
1471 }
1472
1473 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SHASX(uint32_t op1, uint32_t op2)
1474 {
1475   uint32_t result;
1476
1477   __ASM volatile ("shasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1478   return(result);
1479 }
1480
1481 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UASX(uint32_t op1, uint32_t op2)
1482 {
1483   uint32_t result;
1484
1485   __ASM volatile ("uasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1486   return(result);
1487 }
1488
1489 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UQASX(uint32_t op1, uint32_t op2)
1490 {
1491   uint32_t result;
1492
1493   __ASM volatile ("uqasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1494   return(result);
1495 }
1496
1497 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UHASX(uint32_t op1, uint32_t op2)
1498 {
1499   uint32_t result;
1500
1501   __ASM volatile ("uhasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1502   return(result);
1503 }
1504
1505 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SSAX(uint32_t op1, uint32_t op2)
1506 {
1507   uint32_t result;
1508
1509   __ASM volatile ("ssax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1510   return(result);
1511 }
1512
1513 __attribute__((always_inline)) __STATIC_INLINE uint32_t __QSAX(uint32_t op1, uint32_t op2)
1514 {
1515   uint32_t result;
1516
1517   __ASM volatile ("qsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1518   return(result);
1519 }
1520
1521 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SHSAX(uint32_t op1, uint32_t op2)
1522 {
1523   uint32_t result;
1524
1525   __ASM volatile ("shsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1526   return(result);
1527 }
1528
1529 __attribute__((always_inline)) __STATIC_INLINE uint32_t __USAX(uint32_t op1, uint32_t op2)
1530 {
1531   uint32_t result;
1532
1533   __ASM volatile ("usax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1534   return(result);
1535 }
1536
1537 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UQSAX(uint32_t op1, uint32_t op2)
1538 {
1539   uint32_t result;
1540
1541   __ASM volatile ("uqsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1542   return(result);
1543 }
1544
1545 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UHSAX(uint32_t op1, uint32_t op2)
1546 {
1547   uint32_t result;
1548
1549   __ASM volatile ("uhsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1550   return(result);
1551 }
1552
1553 __attribute__((always_inline)) __STATIC_INLINE uint32_t __USAD8(uint32_t op1, uint32_t op2)
1554 {
1555   uint32_t result;
1556
1557   __ASM volatile ("usad8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1558   return(result);
1559 }
1560
1561 __attribute__((always_inline)) __STATIC_INLINE uint32_t __USADA8(uint32_t op1, uint32_t op2, uint32_t op3)
1562 {
1563   uint32_t result;
1564
1565   __ASM volatile ("usada8 %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
1566   return(result);
1567 }
1568
1569 #define __SSAT16(ARG1,ARG2) \
1570 ({                          \
1571   uint32_t __RES, __ARG1 = (ARG1); \
1572   __ASM ("ssat16 %0, %1, %2" : "=r" (__RES) :  "I" (ARG2), "r" (__ARG1) ); \
1573   __RES; \
1574  })
1575
1576 #define __USAT16(ARG1,ARG2) \
1577 ({                          \
1578   uint32_t __RES, __ARG1 = (ARG1); \
1579   __ASM ("usat16 %0, %1, %2" : "=r" (__RES) :  "I" (ARG2), "r" (__ARG1) ); \
1580   __RES; \
1581  })
1582
1583 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UXTB16(uint32_t op1)
1584 {
1585   uint32_t result;
1586
1587   __ASM volatile ("uxtb16 %0, %1" : "=r" (result) : "r" (op1));
1588   return(result);
1589 }
1590
1591 __attribute__((always_inline)) __STATIC_INLINE uint32_t __UXTAB16(uint32_t op1, uint32_t op2)
1592 {
1593   uint32_t result;
1594
1595   __ASM volatile ("uxtab16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1596   return(result);
1597 }
1598
1599 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SXTB16(uint32_t op1)
1600 {
1601   uint32_t result;
1602
1603   __ASM volatile ("sxtb16 %0, %1" : "=r" (result) : "r" (op1));
1604   return(result);
1605 }
1606
1607 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SXTAB16(uint32_t op1, uint32_t op2)
1608 {
1609   uint32_t result;
1610
1611   __ASM volatile ("sxtab16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1612   return(result);
1613 }
1614
1615 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SMUAD  (uint32_t op1, uint32_t op2)
1616 {
1617   uint32_t result;
1618
1619   __ASM volatile ("smuad %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1620   return(result);
1621 }
1622
1623 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SMUADX (uint32_t op1, uint32_t op2)
1624 {
1625   uint32_t result;
1626
1627   __ASM volatile ("smuadx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1628   return(result);
1629 }
1630
1631 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SMLAD (uint32_t op1, uint32_t op2, uint32_t op3)
1632 {
1633   uint32_t result;
1634
1635   __ASM volatile ("smlad %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
1636   return(result);
1637 }
1638
1639 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SMLADX (uint32_t op1, uint32_t op2, uint32_t op3)
1640 {
1641   uint32_t result;
1642
1643   __ASM volatile ("smladx %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
1644   return(result);
1645 }
1646
1647 __attribute__((always_inline)) __STATIC_INLINE uint64_t __SMLALD (uint32_t op1, uint32_t op2, uint64_t acc)
1648 {
1649   union llreg_u{
1650     uint32_t w32[2];
1651     uint64_t w64;
1652   } llr;
1653   llr.w64 = acc;
1654
1655 #ifndef __ARMEB__   /* Little endian */
1656   __ASM volatile ("smlald %0, %1, %2, %3" : "=r" (llr.w32[0]), "=r" (llr.w32[1]): "r" (op1), "r" (op2) , "0" (llr.w32[0]), "1" (llr.w32[1]) );
1657 #else               /* Big endian */
1658   __ASM volatile ("smlald %0, %1, %2, %3" : "=r" (llr.w32[1]), "=r" (llr.w32[0]): "r" (op1), "r" (op2) , "0" (llr.w32[1]), "1" (llr.w32[0]) );
1659 #endif
1660
1661   return(llr.w64);
1662 }
1663
1664 __attribute__((always_inline)) __STATIC_INLINE uint64_t __SMLALDX (uint32_t op1, uint32_t op2, uint64_t acc)
1665 {
1666   union llreg_u{
1667     uint32_t w32[2];
1668     uint64_t w64;
1669   } llr;
1670   llr.w64 = acc;
1671
1672 #ifndef __ARMEB__   /* Little endian */
1673   __ASM volatile ("smlaldx %0, %1, %2, %3" : "=r" (llr.w32[0]), "=r" (llr.w32[1]): "r" (op1), "r" (op2) , "0" (llr.w32[0]), "1" (llr.w32[1]) );
1674 #else               /* Big endian */
1675   __ASM volatile ("smlaldx %0, %1, %2, %3" : "=r" (llr.w32[1]), "=r" (llr.w32[0]): "r" (op1), "r" (op2) , "0" (llr.w32[1]), "1" (llr.w32[0]) );
1676 #endif
1677
1678   return(llr.w64);
1679 }
1680
1681 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SMUSD  (uint32_t op1, uint32_t op2)
1682 {
1683   uint32_t result;
1684
1685   __ASM volatile ("smusd %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1686   return(result);
1687 }
1688
1689 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SMUSDX (uint32_t op1, uint32_t op2)
1690 {
1691   uint32_t result;
1692
1693   __ASM volatile ("smusdx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1694   return(result);
1695 }
1696
1697 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SMLSD (uint32_t op1, uint32_t op2, uint32_t op3)
1698 {
1699   uint32_t result;
1700
1701   __ASM volatile ("smlsd %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
1702   return(result);
1703 }
1704
1705 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SMLSDX (uint32_t op1, uint32_t op2, uint32_t op3)
1706 {
1707   uint32_t result;
1708
1709   __ASM volatile ("smlsdx %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
1710   return(result);
1711 }
1712
1713 __attribute__((always_inline)) __STATIC_INLINE uint64_t __SMLSLD (uint32_t op1, uint32_t op2, uint64_t acc)
1714 {
1715   union llreg_u{
1716     uint32_t w32[2];
1717     uint64_t w64;
1718   } llr;
1719   llr.w64 = acc;
1720
1721 #ifndef __ARMEB__   /* Little endian */
1722   __ASM volatile ("smlsld %0, %1, %2, %3" : "=r" (llr.w32[0]), "=r" (llr.w32[1]): "r" (op1), "r" (op2) , "0" (llr.w32[0]), "1" (llr.w32[1]) );
1723 #else               /* Big endian */
1724   __ASM volatile ("smlsld %0, %1, %2, %3" : "=r" (llr.w32[1]), "=r" (llr.w32[0]): "r" (op1), "r" (op2) , "0" (llr.w32[1]), "1" (llr.w32[0]) );
1725 #endif
1726
1727   return(llr.w64);
1728 }
1729
1730 __attribute__((always_inline)) __STATIC_INLINE uint64_t __SMLSLDX (uint32_t op1, uint32_t op2, uint64_t acc)
1731 {
1732   union llreg_u{
1733     uint32_t w32[2];
1734     uint64_t w64;
1735   } llr;
1736   llr.w64 = acc;
1737
1738 #ifndef __ARMEB__   /* Little endian */
1739   __ASM volatile ("smlsldx %0, %1, %2, %3" : "=r" (llr.w32[0]), "=r" (llr.w32[1]): "r" (op1), "r" (op2) , "0" (llr.w32[0]), "1" (llr.w32[1]) );
1740 #else               /* Big endian */
1741   __ASM volatile ("smlsldx %0, %1, %2, %3" : "=r" (llr.w32[1]), "=r" (llr.w32[0]): "r" (op1), "r" (op2) , "0" (llr.w32[1]), "1" (llr.w32[0]) );
1742 #endif
1743
1744   return(llr.w64);
1745 }
1746
1747 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SEL  (uint32_t op1, uint32_t op2)
1748 {
1749   uint32_t result;
1750
1751   __ASM volatile ("sel %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1752   return(result);
1753 }
1754
1755 __attribute__((always_inline)) __STATIC_INLINE  int32_t __QADD( int32_t op1,  int32_t op2)
1756 {
1757   int32_t result;
1758
1759   __ASM volatile ("qadd %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1760   return(result);
1761 }
1762
1763 __attribute__((always_inline)) __STATIC_INLINE  int32_t __QSUB( int32_t op1,  int32_t op2)
1764 {
1765   int32_t result;
1766
1767   __ASM volatile ("qsub %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
1768   return(result);
1769 }
1770
1771 #define __PKHBT(ARG1,ARG2,ARG3) \
1772 ({                          \
1773   uint32_t __RES, __ARG1 = (ARG1), __ARG2 = (ARG2); \
1774   __ASM ("pkhbt %0, %1, %2, lsl %3" : "=r" (__RES) :  "r" (__ARG1), "r" (__ARG2), "I" (ARG3)  ); \
1775   __RES; \
1776  })
1777
1778 #define __PKHTB(ARG1,ARG2,ARG3) \
1779 ({                          \
1780   uint32_t __RES, __ARG1 = (ARG1), __ARG2 = (ARG2); \
1781   if (ARG3 == 0) \
1782     __ASM ("pkhtb %0, %1, %2" : "=r" (__RES) :  "r" (__ARG1), "r" (__ARG2)  ); \
1783   else \
1784     __ASM ("pkhtb %0, %1, %2, asr %3" : "=r" (__RES) :  "r" (__ARG1), "r" (__ARG2), "I" (ARG3)  ); \
1785   __RES; \
1786  })
1787
1788 __attribute__((always_inline)) __STATIC_INLINE uint32_t __SMMLA (int32_t op1, int32_t op2, int32_t op3)
1789 {
1790  int32_t result;
1791
1792  __ASM volatile ("smmla %0, %1, %2, %3" : "=r" (result): "r"  (op1), "r" (op2), "r" (op3) );
1793  return(result);
1794 }
1795
1796 #endif /* (__ARM_FEATURE_DSP == 1U) */
1797 /*@} end of group CMSIS_SIMD_intrinsics */
1798
1799
1800 #endif /* __CMSIS_ARMCC_V6_H */