| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398 |
- /*
- * Distributed under the Boost Software License, Version 1.0.
- * (See accompanying file LICENSE_1_0.txt or copy at
- * http://www.boost.org/LICENSE_1_0.txt)
- *
- * Copyright (c) 2009 Helge Bahmann
- * Copyright (c) 2013 Tim Blechmann
- * Copyright (c) 2014 Andrey Semashev
- */
- /*!
- * \file atomic/detail/ops_gcc_arm.hpp
- *
- * This header contains implementation of the \c operations template.
- */
- #ifndef BOOST_ATOMIC_DETAIL_OPS_GCC_ARM_HPP_INCLUDED_
- #define BOOST_ATOMIC_DETAIL_OPS_GCC_ARM_HPP_INCLUDED_
- #include <cstddef>
- #include <boost/cstdint.hpp>
- #include <boost/memory_order.hpp>
- #include <boost/atomic/detail/config.hpp>
- #include <boost/atomic/detail/storage_type.hpp>
- #include <boost/atomic/detail/integral_extend.hpp>
- #include <boost/atomic/detail/operations_fwd.hpp>
- #include <boost/atomic/detail/ops_gcc_arm_common.hpp>
- #include <boost/atomic/capabilities.hpp>
- #ifdef BOOST_HAS_PRAGMA_ONCE
- #pragma once
- #endif
- namespace boost {
- namespace atomics {
- namespace detail {
- // From the ARM Architecture Reference Manual for architecture v6:
- //
- // LDREX{<cond>} <Rd>, [<Rn>]
- // <Rd> Specifies the destination register for the memory word addressed by <Rd>
- // <Rn> Specifies the register containing the address.
- //
- // STREX{<cond>} <Rd>, <Rm>, [<Rn>]
- // <Rd> Specifies the destination register for the returned status value.
- // 0 if the operation updates memory
- // 1 if the operation fails to update memory
- // <Rm> Specifies the register containing the word to be stored to memory.
- // <Rn> Specifies the register containing the address.
- // Rd must not be the same register as Rm or Rn.
- //
- // ARM v7 is like ARM v6 plus:
- // There are half-word and byte versions of the LDREX and STREX instructions,
- // LDREXH, LDREXB, STREXH and STREXB.
- // There are also double-word versions, LDREXD and STREXD.
- // (Actually it looks like these are available from version 6k onwards.)
- // FIXME these are not yet used; should be mostly a matter of copy-and-paste.
- // I think you can supply an immediate offset to the address.
- template< bool Signed >
- struct operations< 4u, Signed > :
- public gcc_arm_operations_base
- {
- typedef typename make_storage_type< 4u >::type storage_type;
- typedef typename make_storage_type< 4u >::aligned aligned_storage_type;
- static BOOST_CONSTEXPR_OR_CONST std::size_t storage_size = 4u;
- static BOOST_CONSTEXPR_OR_CONST bool is_signed = Signed;
- static BOOST_FORCEINLINE void store(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- storage = v;
- fence_after_store(order);
- }
- static BOOST_FORCEINLINE storage_type load(storage_type const volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- storage_type v = storage;
- fence_after(order);
- return v;
- }
- static BOOST_FORCEINLINE storage_type exchange(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- storage_type original;
- fence_before(order);
- uint32_t tmp;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // load the original value
- "strex %[tmp], %[value], %[storage]\n" // store the replacement, tmp = store failed
- "teq %[tmp], #0\n" // check if store succeeded
- "bne 1b\n"
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [tmp] "=&l" (tmp), [original] "=&r" (original), [storage] "+Q" (storage)
- : [value] "r" (v)
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE bool compare_exchange_weak(
- storage_type volatile& storage, storage_type& expected, storage_type desired, memory_order success_order, memory_order failure_order) BOOST_NOEXCEPT
- {
- fence_before(success_order);
- uint32_t success;
- uint32_t tmp;
- storage_type original;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "mov %[success], #0\n" // success = 0
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "cmp %[original], %[expected]\n" // flags = original==expected
- "itt eq\n" // [hint that the following 2 instructions are conditional on flags.equal]
- "strexeq %[success], %[desired], %[storage]\n" // if (flags.equal) *(&storage) = desired, success = store failed
- "eoreq %[success], %[success], #1\n" // if (flags.equal) success ^= 1 (i.e. make it 1 if store succeeded)
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [success] "=&r" (success), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [expected] "Ir" (expected), // %4
- [desired] "r" (desired) // %5
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- if (success)
- fence_after(success_order);
- else
- fence_after(failure_order);
- expected = original;
- return !!success;
- }
- static BOOST_FORCEINLINE bool compare_exchange_strong(
- storage_type volatile& storage, storage_type& expected, storage_type desired, memory_order success_order, memory_order failure_order) BOOST_NOEXCEPT
- {
- fence_before(success_order);
- uint32_t success;
- uint32_t tmp;
- storage_type original;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "mov %[success], #0\n" // success = 0
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "cmp %[original], %[expected]\n" // flags = original==expected
- "bne 2f\n" // if (!flags.equal) goto end
- "strex %[success], %[desired], %[storage]\n" // *(&storage) = desired, success = store failed
- "eors %[success], %[success], #1\n" // success ^= 1 (i.e. make it 1 if store succeeded); flags.equal = success == 0
- "beq 1b\n" // if (flags.equal) goto retry
- "2:\n"
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [success] "=&r" (success), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [expected] "Ir" (expected), // %4
- [desired] "r" (desired) // %5
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- if (success)
- fence_after(success_order);
- else
- fence_after(failure_order);
- expected = original;
- return !!success;
- }
- static BOOST_FORCEINLINE storage_type fetch_add(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "add %[result], %[original], %[value]\n" // result = original + value
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_sub(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "sub %[result], %[original], %[value]\n" // result = original - value
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_and(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "and %[result], %[original], %[value]\n" // result = original & value
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_or(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "orr %[result], %[original], %[value]\n" // result = original | value
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_xor(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "eor %[result], %[original], %[value]\n" // result = original ^ value
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE bool test_and_set(storage_type volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- return !!exchange(storage, (storage_type)1, order);
- }
- static BOOST_FORCEINLINE void clear(storage_type volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- store(storage, 0, order);
- }
- };
- #if defined(BOOST_ATOMIC_DETAIL_ARM_HAS_LDREXB_STREXB)
- template< bool Signed >
- struct operations< 1u, Signed > :
- public gcc_arm_operations_base
- {
- typedef typename make_storage_type< 1u >::type storage_type;
- typedef typename make_storage_type< 1u >::aligned aligned_storage_type;
- typedef typename make_storage_type< 4u >::type extended_storage_type;
- static BOOST_CONSTEXPR_OR_CONST std::size_t storage_size = 1u;
- static BOOST_CONSTEXPR_OR_CONST bool is_signed = Signed;
- static BOOST_FORCEINLINE void store(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- storage = v;
- fence_after_store(order);
- }
- static BOOST_FORCEINLINE storage_type load(storage_type const volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- storage_type v = storage;
- fence_after(order);
- return v;
- }
- static BOOST_FORCEINLINE storage_type exchange(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- extended_storage_type original;
- fence_before(order);
- uint32_t tmp;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexb %[original], %[storage]\n" // load the original value and zero-extend to 32 bits
- "strexb %[tmp], %[value], %[storage]\n" // store the replacement, tmp = store failed
- "teq %[tmp], #0\n" // check if store succeeded
- "bne 1b\n"
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [tmp] "=&l" (tmp), [original] "=&r" (original), [storage] "+Q" (storage)
- : [value] "r" (v)
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE bool compare_exchange_weak(
- storage_type volatile& storage, storage_type& expected, storage_type desired, memory_order success_order, memory_order failure_order) BOOST_NOEXCEPT
- {
- fence_before(success_order);
- uint32_t success;
- uint32_t tmp;
- extended_storage_type original;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "mov %[success], #0\n" // success = 0
- "ldrexb %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "cmp %[original], %[expected]\n" // flags = original==expected
- "itt eq\n" // [hint that the following 2 instructions are conditional on flags.equal]
- "strexbeq %[success], %[desired], %[storage]\n" // if (flags.equal) *(&storage) = desired, success = store failed
- "eoreq %[success], %[success], #1\n" // if (flags.equal) success ^= 1 (i.e. make it 1 if store succeeded)
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [success] "=&r" (success), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [expected] "Ir" (atomics::detail::zero_extend< extended_storage_type >(expected)), // %4
- [desired] "r" (desired) // %5
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- if (success)
- fence_after(success_order);
- else
- fence_after(failure_order);
- expected = static_cast< storage_type >(original);
- return !!success;
- }
- static BOOST_FORCEINLINE bool compare_exchange_strong(
- storage_type volatile& storage, storage_type& expected, storage_type desired, memory_order success_order, memory_order failure_order) BOOST_NOEXCEPT
- {
- fence_before(success_order);
- uint32_t success;
- uint32_t tmp;
- extended_storage_type original;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "mov %[success], #0\n" // success = 0
- "1:\n"
- "ldrexb %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "cmp %[original], %[expected]\n" // flags = original==expected
- "bne 2f\n" // if (!flags.equal) goto end
- "strexb %[success], %[desired], %[storage]\n" // *(&storage) = desired, success = store failed
- "eors %[success], %[success], #1\n" // success ^= 1 (i.e. make it 1 if store succeeded); flags.equal = success == 0
- "beq 1b\n" // if (flags.equal) goto retry
- "2:\n"
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [success] "=&r" (success), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [expected] "Ir" (atomics::detail::zero_extend< extended_storage_type >(expected)), // %4
- [desired] "r" (desired) // %5
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- if (success)
- fence_after(success_order);
- else
- fence_after(failure_order);
- expected = static_cast< storage_type >(original);
- return !!success;
- }
- static BOOST_FORCEINLINE storage_type fetch_add(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- extended_storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexb %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "add %[result], %[original], %[value]\n" // result = original + value
- "strexb %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE storage_type fetch_sub(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- extended_storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexb %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "sub %[result], %[original], %[value]\n" // result = original - value
- "strexb %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE storage_type fetch_and(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- extended_storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexb %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "and %[result], %[original], %[value]\n" // result = original & value
- "strexb %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE storage_type fetch_or(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- extended_storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexb %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "orr %[result], %[original], %[value]\n" // result = original | value
- "strexb %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE storage_type fetch_xor(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- extended_storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexb %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "eor %[result], %[original], %[value]\n" // result = original ^ value
- "strexb %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE bool test_and_set(storage_type volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- return !!exchange(storage, (storage_type)1, order);
- }
- static BOOST_FORCEINLINE void clear(storage_type volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- store(storage, 0, order);
- }
- };
- #else // defined(BOOST_ATOMIC_DETAIL_ARM_HAS_LDREXB_STREXB)
- template< >
- struct operations< 1u, false > :
- public operations< 4u, false >
- {
- typedef operations< 4u, false > base_type;
- typedef base_type::storage_type storage_type;
- static BOOST_FORCEINLINE storage_type fetch_add(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "add %[result], %[original], %[value]\n" // result = original + value
- "uxtb %[result], %[result]\n" // zero extend result from 8 to 32 bits
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_sub(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "sub %[result], %[original], %[value]\n" // result = original - value
- "uxtb %[result], %[result]\n" // zero extend result from 8 to 32 bits
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- };
- template< >
- struct operations< 1u, true > :
- public operations< 4u, true >
- {
- typedef operations< 4u, true > base_type;
- typedef base_type::storage_type storage_type;
- static BOOST_FORCEINLINE storage_type fetch_add(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "add %[result], %[original], %[value]\n" // result = original + value
- "sxtb %[result], %[result]\n" // sign extend result from 8 to 32 bits
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_sub(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "sub %[result], %[original], %[value]\n" // result = original - value
- "sxtb %[result], %[result]\n" // sign extend result from 8 to 32 bits
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- };
- #endif // defined(BOOST_ATOMIC_DETAIL_ARM_HAS_LDREXB_STREXB)
- #if defined(BOOST_ATOMIC_DETAIL_ARM_HAS_LDREXH_STREXH)
- template< bool Signed >
- struct operations< 2u, Signed > :
- public gcc_arm_operations_base
- {
- typedef typename make_storage_type< 2u >::type storage_type;
- typedef typename make_storage_type< 2u >::aligned aligned_storage_type;
- typedef typename make_storage_type< 4u >::type extended_storage_type;
- static BOOST_CONSTEXPR_OR_CONST std::size_t storage_size = 2u;
- static BOOST_CONSTEXPR_OR_CONST bool is_signed = Signed;
- static BOOST_FORCEINLINE void store(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- storage = v;
- fence_after_store(order);
- }
- static BOOST_FORCEINLINE storage_type load(storage_type const volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- storage_type v = storage;
- fence_after(order);
- return v;
- }
- static BOOST_FORCEINLINE storage_type exchange(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- extended_storage_type original;
- fence_before(order);
- uint32_t tmp;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexh %[original], %[storage]\n" // load the original value and zero-extend to 32 bits
- "strexh %[tmp], %[value], %[storage]\n" // store the replacement, tmp = store failed
- "teq %[tmp], #0\n" // check if store succeeded
- "bne 1b\n"
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [tmp] "=&l" (tmp), [original] "=&r" (original), [storage] "+Q" (storage)
- : [value] "r" (v)
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE bool compare_exchange_weak(
- storage_type volatile& storage, storage_type& expected, storage_type desired, memory_order success_order, memory_order failure_order) BOOST_NOEXCEPT
- {
- fence_before(success_order);
- uint32_t success;
- uint32_t tmp;
- extended_storage_type original;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "mov %[success], #0\n" // success = 0
- "ldrexh %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "cmp %[original], %[expected]\n" // flags = original==expected
- "itt eq\n" // [hint that the following 2 instructions are conditional on flags.equal]
- "strexheq %[success], %[desired], %[storage]\n" // if (flags.equal) *(&storage) = desired, success = store failed
- "eoreq %[success], %[success], #1\n" // if (flags.equal) success ^= 1 (i.e. make it 1 if store succeeded)
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [success] "=&r" (success), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [expected] "Ir" (atomics::detail::zero_extend< extended_storage_type >(expected)), // %4
- [desired] "r" (desired) // %5
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- if (success)
- fence_after(success_order);
- else
- fence_after(failure_order);
- expected = static_cast< storage_type >(original);
- return !!success;
- }
- static BOOST_FORCEINLINE bool compare_exchange_strong(
- storage_type volatile& storage, storage_type& expected, storage_type desired, memory_order success_order, memory_order failure_order) BOOST_NOEXCEPT
- {
- fence_before(success_order);
- uint32_t success;
- uint32_t tmp;
- extended_storage_type original;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "mov %[success], #0\n" // success = 0
- "1:\n"
- "ldrexh %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "cmp %[original], %[expected]\n" // flags = original==expected
- "bne 2f\n" // if (!flags.equal) goto end
- "strexh %[success], %[desired], %[storage]\n" // *(&storage) = desired, success = store failed
- "eors %[success], %[success], #1\n" // success ^= 1 (i.e. make it 1 if store succeeded); flags.equal = success == 0
- "beq 1b\n" // if (flags.equal) goto retry
- "2:\n"
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [success] "=&r" (success), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [expected] "Ir" (atomics::detail::zero_extend< extended_storage_type >(expected)), // %4
- [desired] "r" (desired) // %5
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- if (success)
- fence_after(success_order);
- else
- fence_after(failure_order);
- expected = static_cast< storage_type >(original);
- return !!success;
- }
- static BOOST_FORCEINLINE storage_type fetch_add(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- extended_storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexh %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "add %[result], %[original], %[value]\n" // result = original + value
- "strexh %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE storage_type fetch_sub(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- extended_storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexh %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "sub %[result], %[original], %[value]\n" // result = original - value
- "strexh %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE storage_type fetch_and(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- extended_storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexh %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "and %[result], %[original], %[value]\n" // result = original & value
- "strexh %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE storage_type fetch_or(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- extended_storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexh %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "orr %[result], %[original], %[value]\n" // result = original | value
- "strexh %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE storage_type fetch_xor(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- extended_storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrexh %[original], %[storage]\n" // original = zero_extend(*(&storage))
- "eor %[result], %[original], %[value]\n" // result = original ^ value
- "strexh %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return static_cast< storage_type >(original);
- }
- static BOOST_FORCEINLINE bool test_and_set(storage_type volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- return !!exchange(storage, (storage_type)1, order);
- }
- static BOOST_FORCEINLINE void clear(storage_type volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- store(storage, 0, order);
- }
- };
- #else // defined(BOOST_ATOMIC_DETAIL_ARM_HAS_LDREXH_STREXH)
- template< >
- struct operations< 2u, false > :
- public operations< 4u, false >
- {
- typedef operations< 4u, false > base_type;
- typedef base_type::storage_type storage_type;
- static BOOST_FORCEINLINE storage_type fetch_add(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "add %[result], %[original], %[value]\n" // result = original + value
- "uxth %[result], %[result]\n" // zero extend result from 16 to 32 bits
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_sub(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "sub %[result], %[original], %[value]\n" // result = original - value
- "uxth %[result], %[result]\n" // zero extend result from 16 to 32 bits
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- };
- template< >
- struct operations< 2u, true > :
- public operations< 4u, true >
- {
- typedef operations< 4u, true > base_type;
- typedef base_type::storage_type storage_type;
- static BOOST_FORCEINLINE storage_type fetch_add(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "add %[result], %[original], %[value]\n" // result = original + value
- "sxth %[result], %[result]\n" // sign extend result from 16 to 32 bits
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_sub(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- uint32_t tmp;
- storage_type original, result;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%[tmp])
- "1:\n"
- "ldrex %[original], %[storage]\n" // original = *(&storage)
- "sub %[result], %[original], %[value]\n" // result = original - value
- "sxth %[result], %[result]\n" // sign extend result from 16 to 32 bits
- "strex %[tmp], %[result], %[storage]\n" // *(&storage) = result, tmp = store failed
- "teq %[tmp], #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%[tmp])
- : [original] "=&r" (original), // %0
- [result] "=&r" (result), // %1
- [tmp] "=&l" (tmp), // %2
- [storage] "+Q" (storage) // %3
- : [value] "Ir" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC
- );
- fence_after(order);
- return original;
- }
- };
- #endif // defined(BOOST_ATOMIC_DETAIL_ARM_HAS_LDREXH_STREXH)
- #if defined(BOOST_ATOMIC_DETAIL_ARM_HAS_LDREXD_STREXD)
- // Unlike 32-bit operations, for 64-bit loads and stores we must use ldrexd/strexd.
- // Any other instructions result in a non-atomic sequence of 32-bit accesses.
- // See "ARM Architecture Reference Manual ARMv7-A and ARMv7-R edition",
- // Section A3.5.3 "Atomicity in the ARM architecture".
- // In the asm blocks below we have to use 32-bit register pairs to compose 64-bit values.
- // In order to pass the 64-bit operands to/from asm blocks, we use undocumented gcc feature:
- // the lower half (Rt) of the operand is accessible normally, via the numbered placeholder (e.g. %0),
- // and the upper half (Rt2) - via the same placeholder with an 'H' after the '%' sign (e.g. %H0).
- // See: http://hardwarebug.org/2010/07/06/arm-inline-asm-secrets/
- template< bool Signed >
- struct operations< 8u, Signed > :
- public gcc_arm_operations_base
- {
- typedef typename make_storage_type< 8u >::type storage_type;
- typedef typename make_storage_type< 8u >::aligned aligned_storage_type;
- static BOOST_CONSTEXPR_OR_CONST std::size_t storage_size = 8u;
- static BOOST_CONSTEXPR_OR_CONST bool is_signed = Signed;
- static BOOST_FORCEINLINE void store(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- exchange(storage, v, order);
- }
- static BOOST_FORCEINLINE storage_type load(storage_type const volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- storage_type original;
- uint32_t tmp;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%0)
- "ldrexd %1, %H1, [%2]\n"
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%0)
- : BOOST_ATOMIC_DETAIL_ARM_ASM_TMPREG_CONSTRAINT(tmp), // %0
- "=&r" (original) // %1
- : "r" (&storage) // %2
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type exchange(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- storage_type original;
- fence_before(order);
- uint32_t tmp;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%0)
- "1:\n"
- "ldrexd %1, %H1, [%3]\n" // load the original value
- "strexd %0, %2, %H2, [%3]\n" // store the replacement, tmp = store failed
- "teq %0, #0\n" // check if store succeeded
- "bne 1b\n"
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%0)
- : BOOST_ATOMIC_DETAIL_ARM_ASM_TMPREG_CONSTRAINT(tmp), // %0
- "=&r" (original) // %1
- : "r" (v), // %2
- "r" (&storage) // %3
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC_COMMA "memory"
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE bool compare_exchange_weak(
- storage_type volatile& storage, storage_type& expected, storage_type desired, memory_order success_order, memory_order failure_order) BOOST_NOEXCEPT
- {
- fence_before(success_order);
- uint32_t tmp;
- storage_type original, old_val = expected;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%0)
- "ldrexd %1, %H1, [%3]\n" // original = *(&storage)
- "cmp %1, %2\n" // flags = original.lo==old_val.lo
- "ittt eq\n" // [hint that the following 3 instructions are conditional on flags.equal]
- "cmpeq %H1, %H2\n" // if (flags.equal) flags = original.hi==old_val.hi
- "strexdeq %0, %4, %H4, [%3]\n" // if (flags.equal) *(&storage) = desired, tmp = store failed
- "teqeq %0, #0\n" // if (flags.equal) flags = tmp==0
- "ite eq\n" // [hint that the following 2 instructions are conditional on flags.equal]
- "moveq %2, #1\n" // if (flags.equal) old_val.lo = 1
- "movne %2, #0\n" // if (!flags.equal) old_val.lo = 0
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%0)
- : BOOST_ATOMIC_DETAIL_ARM_ASM_TMPREG_CONSTRAINT(tmp), // %0
- "=&r" (original), // %1
- "+r" (old_val) // %2
- : "r" (&storage), // %3
- "r" (desired) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC_COMMA "memory"
- );
- const uint32_t success = (uint32_t)old_val;
- if (success)
- fence_after(success_order);
- else
- fence_after(failure_order);
- expected = original;
- return !!success;
- }
- static BOOST_FORCEINLINE bool compare_exchange_strong(
- storage_type volatile& storage, storage_type& expected, storage_type desired, memory_order success_order, memory_order failure_order) BOOST_NOEXCEPT
- {
- fence_before(success_order);
- uint32_t tmp;
- storage_type original, old_val = expected;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%0)
- "1:\n"
- "ldrexd %1, %H1, [%3]\n" // original = *(&storage)
- "cmp %1, %2\n" // flags = original.lo==old_val.lo
- "it eq\n" // [hint that the following instruction is conditional on flags.equal]
- "cmpeq %H1, %H2\n" // if (flags.equal) flags = original.hi==old_val.hi
- "bne 2f\n" // if (!flags.equal) goto end
- "strexd %0, %4, %H4, [%3]\n" // *(&storage) = desired, tmp = store failed
- "teq %0, #0\n" // flags.equal = tmp == 0
- "bne 1b\n" // if (flags.equal) goto retry
- "2:\n"
- "ite eq\n" // [hint that the following 2 instructions are conditional on flags.equal]
- "moveq %2, #1\n" // if (flags.equal) old_val.lo = 1
- "movne %2, #0\n" // if (!flags.equal) old_val.lo = 0
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%0)
- : BOOST_ATOMIC_DETAIL_ARM_ASM_TMPREG_CONSTRAINT(tmp), // %0
- "=&r" (original), // %1
- "+r" (old_val) // %2
- : "r" (&storage), // %3
- "r" (desired) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC_COMMA "memory"
- );
- const uint32_t success = (uint32_t)old_val;
- if (success)
- fence_after(success_order);
- else
- fence_after(failure_order);
- expected = original;
- return !!success;
- }
- static BOOST_FORCEINLINE storage_type fetch_add(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- storage_type original, result;
- uint32_t tmp;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%0)
- "1:\n"
- "ldrexd %1, %H1, [%3]\n" // original = *(&storage)
- "adds %2, %1, %4\n" // result = original + value
- "adc %H2, %H1, %H4\n"
- "strexd %0, %2, %H2, [%3]\n" // *(&storage) = result, tmp = store failed
- "teq %0, #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%0)
- : BOOST_ATOMIC_DETAIL_ARM_ASM_TMPREG_CONSTRAINT(tmp), // %0
- "=&r" (original), // %1
- "=&r" (result) // %2
- : "r" (&storage), // %3
- "r" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC_COMMA "memory"
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_sub(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- storage_type original, result;
- uint32_t tmp;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%0)
- "1:\n"
- "ldrexd %1, %H1, [%3]\n" // original = *(&storage)
- "subs %2, %1, %4\n" // result = original - value
- "sbc %H2, %H1, %H4\n"
- "strexd %0, %2, %H2, [%3]\n" // *(&storage) = result, tmp = store failed
- "teq %0, #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%0)
- : BOOST_ATOMIC_DETAIL_ARM_ASM_TMPREG_CONSTRAINT(tmp), // %0
- "=&r" (original), // %1
- "=&r" (result) // %2
- : "r" (&storage), // %3
- "r" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC_COMMA "memory"
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_and(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- storage_type original, result;
- uint32_t tmp;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%0)
- "1:\n"
- "ldrexd %1, %H1, [%3]\n" // original = *(&storage)
- "and %2, %1, %4\n" // result = original & value
- "and %H2, %H1, %H4\n"
- "strexd %0, %2, %H2, [%3]\n" // *(&storage) = result, tmp = store failed
- "teq %0, #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%0)
- : BOOST_ATOMIC_DETAIL_ARM_ASM_TMPREG_CONSTRAINT(tmp), // %0
- "=&r" (original), // %1
- "=&r" (result) // %2
- : "r" (&storage), // %3
- "r" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC_COMMA "memory"
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_or(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- storage_type original, result;
- uint32_t tmp;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%0)
- "1:\n"
- "ldrexd %1, %H1, [%3]\n" // original = *(&storage)
- "orr %2, %1, %4\n" // result = original | value
- "orr %H2, %H1, %H4\n"
- "strexd %0, %2, %H2, [%3]\n" // *(&storage) = result, tmp = store failed
- "teq %0, #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%0)
- : BOOST_ATOMIC_DETAIL_ARM_ASM_TMPREG_CONSTRAINT(tmp), // %0
- "=&r" (original), // %1
- "=&r" (result) // %2
- : "r" (&storage), // %3
- "r" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC_COMMA "memory"
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE storage_type fetch_xor(storage_type volatile& storage, storage_type v, memory_order order) BOOST_NOEXCEPT
- {
- fence_before(order);
- storage_type original, result;
- uint32_t tmp;
- __asm__ __volatile__
- (
- BOOST_ATOMIC_DETAIL_ARM_ASM_START(%0)
- "1:\n"
- "ldrexd %1, %H1, [%3]\n" // original = *(&storage)
- "eor %2, %1, %4\n" // result = original ^ value
- "eor %H2, %H1, %H4\n"
- "strexd %0, %2, %H2, [%3]\n" // *(&storage) = result, tmp = store failed
- "teq %0, #0\n" // flags = tmp==0
- "bne 1b\n" // if (!flags.equal) goto retry
- BOOST_ATOMIC_DETAIL_ARM_ASM_END(%0)
- : BOOST_ATOMIC_DETAIL_ARM_ASM_TMPREG_CONSTRAINT(tmp), // %0
- "=&r" (original), // %1
- "=&r" (result) // %2
- : "r" (&storage), // %3
- "r" (v) // %4
- : BOOST_ATOMIC_DETAIL_ASM_CLOBBER_CC_COMMA "memory"
- );
- fence_after(order);
- return original;
- }
- static BOOST_FORCEINLINE bool test_and_set(storage_type volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- return !!exchange(storage, (storage_type)1, order);
- }
- static BOOST_FORCEINLINE void clear(storage_type volatile& storage, memory_order order) BOOST_NOEXCEPT
- {
- store(storage, 0, order);
- }
- };
- #endif // defined(BOOST_ATOMIC_DETAIL_ARM_HAS_LDREXD_STREXD)
- BOOST_FORCEINLINE void thread_fence(memory_order order) BOOST_NOEXCEPT
- {
- if (order != memory_order_relaxed)
- gcc_arm_operations_base::hardware_full_fence();
- }
- BOOST_FORCEINLINE void signal_fence(memory_order order) BOOST_NOEXCEPT
- {
- if (order != memory_order_relaxed)
- __asm__ __volatile__ ("" ::: "memory");
- }
- } // namespace detail
- } // namespace atomics
- } // namespace boost
- #endif // BOOST_ATOMIC_DETAIL_OPS_GCC_ARM_HPP_INCLUDED_
|