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