Biomimetics MBED Library w/ Added Support for CAN3

Dependents:   CAN_TEST SPIne_Plus_DYNO_SENSORS SPIne_Plus_v2 SPIne_Plus_Dyno_v2

Committer:
saloutos
Date:
Thu Nov 26 04:08:56 2020 +0000
Revision:
0:083111ae2a11
first commit of leaned mbed dev lib

Who changed what in which revision?

UserRevisionLine numberNew contents of line
saloutos 0:083111ae2a11 1 /* mbed Microcontroller Library
saloutos 0:083111ae2a11 2 * Copyright (c) 2006-2016 ARM Limited
saloutos 0:083111ae2a11 3 *
saloutos 0:083111ae2a11 4 * Licensed under the Apache License, Version 2.0 (the "License");
saloutos 0:083111ae2a11 5 * you may not use this file except in compliance with the License.
saloutos 0:083111ae2a11 6 * You may obtain a copy of the License at
saloutos 0:083111ae2a11 7 *
saloutos 0:083111ae2a11 8 * http://www.apache.org/licenses/LICENSE-2.0
saloutos 0:083111ae2a11 9 *
saloutos 0:083111ae2a11 10 * Unless required by applicable law or agreed to in writing, software
saloutos 0:083111ae2a11 11 * distributed under the License is distributed on an "AS IS" BASIS,
saloutos 0:083111ae2a11 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
saloutos 0:083111ae2a11 13 * See the License for the specific language governing permissions and
saloutos 0:083111ae2a11 14 * limitations under the License.
saloutos 0:083111ae2a11 15 */
saloutos 0:083111ae2a11 16
saloutos 0:083111ae2a11 17 #include <stdlib.h>
saloutos 0:083111ae2a11 18 #include <stdarg.h>
saloutos 0:083111ae2a11 19 #include <stdio.h>
saloutos 0:083111ae2a11 20 #include "platform/mbed_mem_trace.h"
saloutos 0:083111ae2a11 21 #include "platform/mbed_critical.h"
saloutos 0:083111ae2a11 22
saloutos 0:083111ae2a11 23 /******************************************************************************
saloutos 0:083111ae2a11 24 * Internal variables, functions and helpers
saloutos 0:083111ae2a11 25 *****************************************************************************/
saloutos 0:083111ae2a11 26
saloutos 0:083111ae2a11 27 /* The callback function that will be called after a traced memory operations finishes. */
saloutos 0:083111ae2a11 28 static mbed_mem_trace_cb_t mem_trace_cb;
saloutos 0:083111ae2a11 29 /* 'trave_level' guards "trace inside trace" situations (for example, the implementation
saloutos 0:083111ae2a11 30 * of realloc() might call malloc() internally, and since malloc() is also traced, this could
saloutos 0:083111ae2a11 31 * result in two calls to the callback function instead of one. */
saloutos 0:083111ae2a11 32 static uint8_t trace_level;
saloutos 0:083111ae2a11 33
saloutos 0:083111ae2a11 34 /******************************************************************************
saloutos 0:083111ae2a11 35 * Public interface
saloutos 0:083111ae2a11 36 *****************************************************************************/
saloutos 0:083111ae2a11 37
saloutos 0:083111ae2a11 38 void mbed_mem_trace_set_callback(mbed_mem_trace_cb_t cb) {
saloutos 0:083111ae2a11 39 mem_trace_cb = cb;
saloutos 0:083111ae2a11 40 }
saloutos 0:083111ae2a11 41
saloutos 0:083111ae2a11 42 void *mbed_mem_trace_malloc(void *res, size_t size, void *caller) {
saloutos 0:083111ae2a11 43 if (mem_trace_cb) {
saloutos 0:083111ae2a11 44 if (core_util_atomic_incr_u8(&trace_level, 1) == 1) {
saloutos 0:083111ae2a11 45 mem_trace_cb(MBED_MEM_TRACE_MALLOC, res, caller, size);
saloutos 0:083111ae2a11 46 }
saloutos 0:083111ae2a11 47 core_util_atomic_decr_u8(&trace_level, 1);
saloutos 0:083111ae2a11 48 }
saloutos 0:083111ae2a11 49 return res;
saloutos 0:083111ae2a11 50 }
saloutos 0:083111ae2a11 51
saloutos 0:083111ae2a11 52 void *mbed_mem_trace_realloc(void *res, void *ptr, size_t size, void *caller) {
saloutos 0:083111ae2a11 53 if (mem_trace_cb) {
saloutos 0:083111ae2a11 54 if (core_util_atomic_incr_u8(&trace_level, 1) == 1) {
saloutos 0:083111ae2a11 55 mem_trace_cb(MBED_MEM_TRACE_REALLOC, res, caller, ptr, size);
saloutos 0:083111ae2a11 56 }
saloutos 0:083111ae2a11 57 core_util_atomic_decr_u8(&trace_level, 1);
saloutos 0:083111ae2a11 58 }
saloutos 0:083111ae2a11 59 return res;
saloutos 0:083111ae2a11 60 }
saloutos 0:083111ae2a11 61
saloutos 0:083111ae2a11 62 void *mbed_mem_trace_calloc(void *res, size_t num, size_t size, void *caller) {
saloutos 0:083111ae2a11 63 if (mem_trace_cb) {
saloutos 0:083111ae2a11 64 if (core_util_atomic_incr_u8(&trace_level, 1) == 1) {
saloutos 0:083111ae2a11 65 mem_trace_cb(MBED_MEM_TRACE_CALLOC, res, caller, num, size);
saloutos 0:083111ae2a11 66 }
saloutos 0:083111ae2a11 67 core_util_atomic_decr_u8(&trace_level, 1);
saloutos 0:083111ae2a11 68 }
saloutos 0:083111ae2a11 69 return res;
saloutos 0:083111ae2a11 70 }
saloutos 0:083111ae2a11 71
saloutos 0:083111ae2a11 72 void mbed_mem_trace_free(void *ptr, void *caller) {
saloutos 0:083111ae2a11 73 if (mem_trace_cb) {
saloutos 0:083111ae2a11 74 if (core_util_atomic_incr_u8(&trace_level, 1) == 1) {
saloutos 0:083111ae2a11 75 mem_trace_cb(MBED_MEM_TRACE_FREE, NULL, caller, ptr);
saloutos 0:083111ae2a11 76 }
saloutos 0:083111ae2a11 77 core_util_atomic_decr_u8(&trace_level, 1);
saloutos 0:083111ae2a11 78 }
saloutos 0:083111ae2a11 79 }
saloutos 0:083111ae2a11 80
saloutos 0:083111ae2a11 81 void mbed_mem_trace_default_callback(uint8_t op, void *res, void *caller, ...) {
saloutos 0:083111ae2a11 82 va_list va;
saloutos 0:083111ae2a11 83 size_t temp_s1, temp_s2;
saloutos 0:083111ae2a11 84 void *temp_ptr;
saloutos 0:083111ae2a11 85
saloutos 0:083111ae2a11 86 va_start(va, caller);
saloutos 0:083111ae2a11 87 switch(op) {
saloutos 0:083111ae2a11 88 case MBED_MEM_TRACE_MALLOC:
saloutos 0:083111ae2a11 89 temp_s1 = va_arg(va, size_t);
saloutos 0:083111ae2a11 90 printf(MBED_MEM_DEFAULT_TRACER_PREFIX "m:%p;%p-%u\n", res, caller, temp_s1);
saloutos 0:083111ae2a11 91 break;
saloutos 0:083111ae2a11 92
saloutos 0:083111ae2a11 93 case MBED_MEM_TRACE_REALLOC:
saloutos 0:083111ae2a11 94 temp_ptr = va_arg(va, void*);
saloutos 0:083111ae2a11 95 temp_s1 = va_arg(va, size_t);
saloutos 0:083111ae2a11 96 printf(MBED_MEM_DEFAULT_TRACER_PREFIX "r:%p;%p-%p;%u\n", res, caller, temp_ptr, temp_s1);
saloutos 0:083111ae2a11 97 break;
saloutos 0:083111ae2a11 98
saloutos 0:083111ae2a11 99 case MBED_MEM_TRACE_CALLOC:
saloutos 0:083111ae2a11 100 temp_s1 = va_arg(va, size_t);
saloutos 0:083111ae2a11 101 temp_s2 = va_arg(va, size_t);
saloutos 0:083111ae2a11 102 printf(MBED_MEM_DEFAULT_TRACER_PREFIX "c:%p;%p-%u;%u\n", res, caller, temp_s1, temp_s2);
saloutos 0:083111ae2a11 103 break;
saloutos 0:083111ae2a11 104
saloutos 0:083111ae2a11 105 case MBED_MEM_TRACE_FREE:
saloutos 0:083111ae2a11 106 temp_ptr = va_arg(va, void*);
saloutos 0:083111ae2a11 107 printf(MBED_MEM_DEFAULT_TRACER_PREFIX "f:%p;%p-%p\n", res, caller, temp_ptr);
saloutos 0:083111ae2a11 108 break;
saloutos 0:083111ae2a11 109
saloutos 0:083111ae2a11 110 default:
saloutos 0:083111ae2a11 111 printf("?\n");
saloutos 0:083111ae2a11 112 }
saloutos 0:083111ae2a11 113 va_end(va);
saloutos 0:083111ae2a11 114 }
saloutos 0:083111ae2a11 115