PES4 / Mbed OS Queue_02
Committer:
demayer
Date:
Sat Apr 11 08:15:48 2020 +0000
Revision:
1:b36bbc1c6d27
Parent:
0:6bf0743ece18
IMU-library in .h und .cpp file aufgeteilt

Who changed what in which revision?

UserRevisionLine numberNew contents of line
demayer 0:6bf0743ece18 1 /* mbed Microcontroller Library
demayer 0:6bf0743ece18 2 * Copyright (c) 2006-2013 ARM Limited
demayer 0:6bf0743ece18 3 *
demayer 0:6bf0743ece18 4 * Licensed under the Apache License, Version 2.0 (the "License");
demayer 0:6bf0743ece18 5 * you may not use this file except in compliance with the License.
demayer 0:6bf0743ece18 6 * You may obtain a copy of the License at
demayer 0:6bf0743ece18 7 *
demayer 0:6bf0743ece18 8 * http://www.apache.org/licenses/LICENSE-2.0
demayer 0:6bf0743ece18 9 *
demayer 0:6bf0743ece18 10 * Unless required by applicable law or agreed to in writing, software
demayer 0:6bf0743ece18 11 * distributed under the License is distributed on an "AS IS" BASIS,
demayer 0:6bf0743ece18 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
demayer 0:6bf0743ece18 13 * See the License for the specific language governing permissions and
demayer 0:6bf0743ece18 14 * limitations under the License.
demayer 0:6bf0743ece18 15 */
demayer 0:6bf0743ece18 16 #include <stdio.h>
demayer 0:6bf0743ece18 17 #include "platform/mbed_interface.h"
demayer 0:6bf0743ece18 18
demayer 0:6bf0743ece18 19 #include "hal/gpio_api.h"
demayer 0:6bf0743ece18 20 #include "platform/mbed_wait_api.h"
demayer 0:6bf0743ece18 21 #include "platform/mbed_semihost_api.h"
demayer 0:6bf0743ece18 22 #include "platform/mbed_error.h"
demayer 0:6bf0743ece18 23 #include "platform/mbed_toolchain.h"
demayer 0:6bf0743ece18 24
demayer 0:6bf0743ece18 25 #if DEVICE_SEMIHOST
demayer 0:6bf0743ece18 26
demayer 0:6bf0743ece18 27 // return true if a debugger is attached, indicating mbed interface is connected
demayer 0:6bf0743ece18 28 int mbed_interface_connected(void) {
demayer 0:6bf0743ece18 29 return semihost_connected();
demayer 0:6bf0743ece18 30 }
demayer 0:6bf0743ece18 31
demayer 0:6bf0743ece18 32 int mbed_interface_reset(void) {
demayer 0:6bf0743ece18 33 if (mbed_interface_connected()) {
demayer 0:6bf0743ece18 34 semihost_reset();
demayer 0:6bf0743ece18 35 return 0;
demayer 0:6bf0743ece18 36 } else {
demayer 0:6bf0743ece18 37 return -1;
demayer 0:6bf0743ece18 38 }
demayer 0:6bf0743ece18 39 }
demayer 0:6bf0743ece18 40
demayer 0:6bf0743ece18 41 WEAK int mbed_interface_uid(char *uid) {
demayer 0:6bf0743ece18 42 if (mbed_interface_connected()) {
demayer 0:6bf0743ece18 43 return semihost_uid(uid); // Returns 0 if successful, -1 on failure
demayer 0:6bf0743ece18 44 } else {
demayer 0:6bf0743ece18 45 uid[0] = 0;
demayer 0:6bf0743ece18 46 return -1;
demayer 0:6bf0743ece18 47 }
demayer 0:6bf0743ece18 48 }
demayer 0:6bf0743ece18 49
demayer 0:6bf0743ece18 50 int mbed_interface_disconnect(void) {
demayer 0:6bf0743ece18 51 int res;
demayer 0:6bf0743ece18 52 if (mbed_interface_connected()) {
demayer 0:6bf0743ece18 53 if ((res = semihost_disabledebug()) != 0)
demayer 0:6bf0743ece18 54 return res;
demayer 0:6bf0743ece18 55 while (mbed_interface_connected());
demayer 0:6bf0743ece18 56 return 0;
demayer 0:6bf0743ece18 57 } else {
demayer 0:6bf0743ece18 58 return -1;
demayer 0:6bf0743ece18 59 }
demayer 0:6bf0743ece18 60 }
demayer 0:6bf0743ece18 61
demayer 0:6bf0743ece18 62 int mbed_interface_powerdown(void) {
demayer 0:6bf0743ece18 63 int res;
demayer 0:6bf0743ece18 64 if (mbed_interface_connected()) {
demayer 0:6bf0743ece18 65 if ((res = semihost_powerdown()) != 0)
demayer 0:6bf0743ece18 66 return res;
demayer 0:6bf0743ece18 67 while (mbed_interface_connected());
demayer 0:6bf0743ece18 68 return 0;
demayer 0:6bf0743ece18 69 } else {
demayer 0:6bf0743ece18 70 return -1;
demayer 0:6bf0743ece18 71 }
demayer 0:6bf0743ece18 72 }
demayer 0:6bf0743ece18 73
demayer 0:6bf0743ece18 74 // for backward compatibility
demayer 0:6bf0743ece18 75 void mbed_reset(void) {
demayer 0:6bf0743ece18 76 mbed_interface_reset();
demayer 0:6bf0743ece18 77 }
demayer 0:6bf0743ece18 78
demayer 0:6bf0743ece18 79 WEAK int mbed_uid(char *uid) {
demayer 0:6bf0743ece18 80 return mbed_interface_uid(uid);
demayer 0:6bf0743ece18 81 }
demayer 0:6bf0743ece18 82 #endif
demayer 0:6bf0743ece18 83
demayer 0:6bf0743ece18 84 WEAK void mbed_mac_address(char *mac) {
demayer 0:6bf0743ece18 85 #if DEVICE_SEMIHOST
demayer 0:6bf0743ece18 86 char uid[DEVICE_ID_LENGTH + 1];
demayer 0:6bf0743ece18 87 int i;
demayer 0:6bf0743ece18 88
demayer 0:6bf0743ece18 89 // if we have a UID, extract the MAC
demayer 0:6bf0743ece18 90 if (mbed_interface_uid(uid) == 0) {
demayer 0:6bf0743ece18 91 char *p = uid;
demayer 0:6bf0743ece18 92 #if defined(DEVICE_MAC_OFFSET)
demayer 0:6bf0743ece18 93 p += DEVICE_MAC_OFFSET;
demayer 0:6bf0743ece18 94 #endif
demayer 0:6bf0743ece18 95 for (i=0; i<6; i++) {
demayer 0:6bf0743ece18 96 int byte;
demayer 0:6bf0743ece18 97 sscanf(p, "%2x", &byte);
demayer 0:6bf0743ece18 98 mac[i] = byte;
demayer 0:6bf0743ece18 99 p += 2;
demayer 0:6bf0743ece18 100 }
demayer 0:6bf0743ece18 101 mac[0] &= ~0x01; // reset the IG bit in the address; see IEE 802.3-2002, Section 3.2.3(b)
demayer 0:6bf0743ece18 102 } else { // else return a default MAC
demayer 0:6bf0743ece18 103 #endif
demayer 0:6bf0743ece18 104 mac[0] = 0x00;
demayer 0:6bf0743ece18 105 mac[1] = 0x02;
demayer 0:6bf0743ece18 106 mac[2] = 0xF7;
demayer 0:6bf0743ece18 107 mac[3] = 0xF0;
demayer 0:6bf0743ece18 108 mac[4] = 0x00;
demayer 0:6bf0743ece18 109 mac[5] = 0x00;
demayer 0:6bf0743ece18 110 #if DEVICE_SEMIHOST
demayer 0:6bf0743ece18 111 }
demayer 0:6bf0743ece18 112 #endif
demayer 0:6bf0743ece18 113 }