Programme gyro_accelero avec acquisition accelero + calcul téta

Dependents:   Gyro_Accelerometre2

Committer:
SandrineO
Date:
Tue Feb 20 15:58:26 2018 +0000
Revision:
0:07281ea3b26b
temps r?el

Who changed what in which revision?

UserRevisionLine numberNew contents of line
SandrineO 0:07281ea3b26b 1 /* mbed Microcontroller Library
SandrineO 0:07281ea3b26b 2 * Copyright (c) 2006-2012 ARM Limited
SandrineO 0:07281ea3b26b 3 *
SandrineO 0:07281ea3b26b 4 * Permission is hereby granted, free of charge, to any person obtaining a copy
SandrineO 0:07281ea3b26b 5 * of this software and associated documentation files (the "Software"), to deal
SandrineO 0:07281ea3b26b 6 * in the Software without restriction, including without limitation the rights
SandrineO 0:07281ea3b26b 7 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
SandrineO 0:07281ea3b26b 8 * copies of the Software, and to permit persons to whom the Software is
SandrineO 0:07281ea3b26b 9 * furnished to do so, subject to the following conditions:
SandrineO 0:07281ea3b26b 10 *
SandrineO 0:07281ea3b26b 11 * The above copyright notice and this permission notice shall be included in
SandrineO 0:07281ea3b26b 12 * all copies or substantial portions of the Software.
SandrineO 0:07281ea3b26b 13 *
SandrineO 0:07281ea3b26b 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
SandrineO 0:07281ea3b26b 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
SandrineO 0:07281ea3b26b 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
SandrineO 0:07281ea3b26b 17 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
SandrineO 0:07281ea3b26b 18 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
SandrineO 0:07281ea3b26b 19 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
SandrineO 0:07281ea3b26b 20 * SOFTWARE.
SandrineO 0:07281ea3b26b 21 */
SandrineO 0:07281ea3b26b 22 #ifndef MEMORYPOOL_H
SandrineO 0:07281ea3b26b 23 #define MEMORYPOOL_H
SandrineO 0:07281ea3b26b 24
SandrineO 0:07281ea3b26b 25 #include <stdint.h>
SandrineO 0:07281ea3b26b 26 #include <string.h>
SandrineO 0:07281ea3b26b 27
SandrineO 0:07281ea3b26b 28 #include "cmsis_os.h"
SandrineO 0:07281ea3b26b 29
SandrineO 0:07281ea3b26b 30 namespace rtos {
SandrineO 0:07281ea3b26b 31 /** \addtogroup rtos */
SandrineO 0:07281ea3b26b 32 /** @{*/
SandrineO 0:07281ea3b26b 33
SandrineO 0:07281ea3b26b 34 /** Define and manage fixed-size memory pools of objects of a given type.
SandrineO 0:07281ea3b26b 35 @tparam T data type of a single object (element).
SandrineO 0:07281ea3b26b 36 @tparam queue_sz maximum number of objects (elements) in the memory pool.
SandrineO 0:07281ea3b26b 37 */
SandrineO 0:07281ea3b26b 38 template<typename T, uint32_t pool_sz>
SandrineO 0:07281ea3b26b 39 class MemoryPool {
SandrineO 0:07281ea3b26b 40 public:
SandrineO 0:07281ea3b26b 41 /** Create and Initialize a memory pool. */
SandrineO 0:07281ea3b26b 42 MemoryPool() {
SandrineO 0:07281ea3b26b 43 #ifdef CMSIS_OS_RTX
SandrineO 0:07281ea3b26b 44 memset(_pool_m, 0, sizeof(_pool_m));
SandrineO 0:07281ea3b26b 45 _pool_def.pool = _pool_m;
SandrineO 0:07281ea3b26b 46
SandrineO 0:07281ea3b26b 47 _pool_def.pool_sz = pool_sz;
SandrineO 0:07281ea3b26b 48 _pool_def.item_sz = sizeof(T);
SandrineO 0:07281ea3b26b 49 #endif
SandrineO 0:07281ea3b26b 50 _pool_id = osPoolCreate(&_pool_def);
SandrineO 0:07281ea3b26b 51 }
SandrineO 0:07281ea3b26b 52
SandrineO 0:07281ea3b26b 53 /** Allocate a memory block of type T from a memory pool.
SandrineO 0:07281ea3b26b 54 @return address of the allocated memory block or NULL in case of no memory available.
SandrineO 0:07281ea3b26b 55 */
SandrineO 0:07281ea3b26b 56 T* alloc(void) {
SandrineO 0:07281ea3b26b 57 return (T*)osPoolAlloc(_pool_id);
SandrineO 0:07281ea3b26b 58 }
SandrineO 0:07281ea3b26b 59
SandrineO 0:07281ea3b26b 60 /** Allocate a memory block of type T from a memory pool and set memory block to zero.
SandrineO 0:07281ea3b26b 61 @return address of the allocated memory block or NULL in case of no memory available.
SandrineO 0:07281ea3b26b 62 */
SandrineO 0:07281ea3b26b 63 T* calloc(void) {
SandrineO 0:07281ea3b26b 64 return (T*)osPoolCAlloc(_pool_id);
SandrineO 0:07281ea3b26b 65 }
SandrineO 0:07281ea3b26b 66
SandrineO 0:07281ea3b26b 67 /** Return an allocated memory block back to a specific memory pool.
SandrineO 0:07281ea3b26b 68 @param address of the allocated memory block that is returned to the memory pool.
SandrineO 0:07281ea3b26b 69 @return status code that indicates the execution status of the function.
SandrineO 0:07281ea3b26b 70 */
SandrineO 0:07281ea3b26b 71 osStatus free(T *block) {
SandrineO 0:07281ea3b26b 72 return osPoolFree(_pool_id, (void*)block);
SandrineO 0:07281ea3b26b 73 }
SandrineO 0:07281ea3b26b 74
SandrineO 0:07281ea3b26b 75 private:
SandrineO 0:07281ea3b26b 76 osPoolId _pool_id;
SandrineO 0:07281ea3b26b 77 osPoolDef_t _pool_def;
SandrineO 0:07281ea3b26b 78 #ifdef CMSIS_OS_RTX
SandrineO 0:07281ea3b26b 79 uint32_t _pool_m[3+((sizeof(T)+3)/4)*(pool_sz)];
SandrineO 0:07281ea3b26b 80 #endif
SandrineO 0:07281ea3b26b 81 };
SandrineO 0:07281ea3b26b 82
SandrineO 0:07281ea3b26b 83 }
SandrineO 0:07281ea3b26b 84 #endif
SandrineO 0:07281ea3b26b 85
SandrineO 0:07281ea3b26b 86 /** @}*/