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 "cmsis.h"
demayer 0:6bf0743ece18 17 #include "platform/mbed_semihost_api.h"
demayer 0:6bf0743ece18 18
demayer 0:6bf0743ece18 19 #include <stdint.h>
demayer 0:6bf0743ece18 20 #include <string.h>
demayer 0:6bf0743ece18 21
demayer 0:6bf0743ece18 22 #if DEVICE_SEMIHOST
demayer 0:6bf0743ece18 23
demayer 0:6bf0743ece18 24 // ARM Semihosting Commands
demayer 0:6bf0743ece18 25 #define SYS_OPEN (0x1)
demayer 0:6bf0743ece18 26 #define SYS_CLOSE (0x2)
demayer 0:6bf0743ece18 27 #define SYS_WRITE (0x5)
demayer 0:6bf0743ece18 28 #define SYS_READ (0x6)
demayer 0:6bf0743ece18 29 #define SYS_ISTTY (0x9)
demayer 0:6bf0743ece18 30 #define SYS_SEEK (0xa)
demayer 0:6bf0743ece18 31 #define SYS_ENSURE (0xb)
demayer 0:6bf0743ece18 32 #define SYS_FLEN (0xc)
demayer 0:6bf0743ece18 33 #define SYS_REMOVE (0xe)
demayer 0:6bf0743ece18 34 #define SYS_RENAME (0xf)
demayer 0:6bf0743ece18 35 #define SYS_EXIT (0x18)
demayer 0:6bf0743ece18 36
demayer 0:6bf0743ece18 37 // mbed Semihosting Commands
demayer 0:6bf0743ece18 38 #define RESERVED_FOR_USER_APPLICATIONS (0x100) // 0x100 - 0x1ff
demayer 0:6bf0743ece18 39 #define USR_XFFIND (RESERVED_FOR_USER_APPLICATIONS + 0)
demayer 0:6bf0743ece18 40 #define USR_UID (RESERVED_FOR_USER_APPLICATIONS + 1)
demayer 0:6bf0743ece18 41 #define USR_RESET (RESERVED_FOR_USER_APPLICATIONS + 2)
demayer 0:6bf0743ece18 42 #define USR_VBUS (RESERVED_FOR_USER_APPLICATIONS + 3)
demayer 0:6bf0743ece18 43 #define USR_POWERDOWN (RESERVED_FOR_USER_APPLICATIONS + 4)
demayer 0:6bf0743ece18 44 #define USR_DISABLEDEBUG (RESERVED_FOR_USER_APPLICATIONS + 5)
demayer 0:6bf0743ece18 45
demayer 0:6bf0743ece18 46 #if DEVICE_LOCALFILESYSTEM
demayer 0:6bf0743ece18 47 FILEHANDLE semihost_open(const char* name, int openmode) {
demayer 0:6bf0743ece18 48 uint32_t args[3];
demayer 0:6bf0743ece18 49 args[0] = (uint32_t)name;
demayer 0:6bf0743ece18 50 args[1] = (uint32_t)openmode;
demayer 0:6bf0743ece18 51 args[2] = (uint32_t)strlen(name);
demayer 0:6bf0743ece18 52 return __semihost(SYS_OPEN, args);
demayer 0:6bf0743ece18 53 }
demayer 0:6bf0743ece18 54
demayer 0:6bf0743ece18 55 int semihost_close(FILEHANDLE fh) {
demayer 0:6bf0743ece18 56 return __semihost(SYS_CLOSE, &fh);
demayer 0:6bf0743ece18 57 }
demayer 0:6bf0743ece18 58
demayer 0:6bf0743ece18 59 int semihost_write(FILEHANDLE fh, const unsigned char* buffer, unsigned int length, int mode) {
demayer 0:6bf0743ece18 60 if (length == 0) return 0;
demayer 0:6bf0743ece18 61
demayer 0:6bf0743ece18 62 uint32_t args[3];
demayer 0:6bf0743ece18 63 args[0] = (uint32_t)fh;
demayer 0:6bf0743ece18 64 args[1] = (uint32_t)buffer;
demayer 0:6bf0743ece18 65 args[2] = (uint32_t)length;
demayer 0:6bf0743ece18 66 return __semihost(SYS_WRITE, args);
demayer 0:6bf0743ece18 67 }
demayer 0:6bf0743ece18 68
demayer 0:6bf0743ece18 69 int semihost_read(FILEHANDLE fh, unsigned char* buffer, unsigned int length, int mode) {
demayer 0:6bf0743ece18 70 uint32_t args[3];
demayer 0:6bf0743ece18 71 args[0] = (uint32_t)fh;
demayer 0:6bf0743ece18 72 args[1] = (uint32_t)buffer;
demayer 0:6bf0743ece18 73 args[2] = (uint32_t)length;
demayer 0:6bf0743ece18 74 return __semihost(SYS_READ, args);
demayer 0:6bf0743ece18 75 }
demayer 0:6bf0743ece18 76
demayer 0:6bf0743ece18 77 int semihost_istty(FILEHANDLE fh) {
demayer 0:6bf0743ece18 78 return __semihost(SYS_ISTTY, &fh);
demayer 0:6bf0743ece18 79 }
demayer 0:6bf0743ece18 80
demayer 0:6bf0743ece18 81 int semihost_seek(FILEHANDLE fh, long position) {
demayer 0:6bf0743ece18 82 uint32_t args[2];
demayer 0:6bf0743ece18 83 args[0] = (uint32_t)fh;
demayer 0:6bf0743ece18 84 args[1] = (uint32_t)position;
demayer 0:6bf0743ece18 85 return __semihost(SYS_SEEK, args);
demayer 0:6bf0743ece18 86 }
demayer 0:6bf0743ece18 87
demayer 0:6bf0743ece18 88 int semihost_ensure(FILEHANDLE fh) {
demayer 0:6bf0743ece18 89 return __semihost(SYS_ENSURE, &fh);
demayer 0:6bf0743ece18 90 }
demayer 0:6bf0743ece18 91
demayer 0:6bf0743ece18 92 long semihost_flen(FILEHANDLE fh) {
demayer 0:6bf0743ece18 93 return __semihost(SYS_FLEN, &fh);
demayer 0:6bf0743ece18 94 }
demayer 0:6bf0743ece18 95
demayer 0:6bf0743ece18 96 int semihost_remove(const char *name) {
demayer 0:6bf0743ece18 97 uint32_t args[2];
demayer 0:6bf0743ece18 98 args[0] = (uint32_t)name;
demayer 0:6bf0743ece18 99 args[1] = (uint32_t)strlen(name);
demayer 0:6bf0743ece18 100 return __semihost(SYS_REMOVE, args);
demayer 0:6bf0743ece18 101 }
demayer 0:6bf0743ece18 102
demayer 0:6bf0743ece18 103 int semihost_rename(const char *old_name, const char *new_name) {
demayer 0:6bf0743ece18 104 uint32_t args[4];
demayer 0:6bf0743ece18 105 args[0] = (uint32_t)old_name;
demayer 0:6bf0743ece18 106 args[1] = (uint32_t)strlen(old_name);
demayer 0:6bf0743ece18 107 args[0] = (uint32_t)new_name;
demayer 0:6bf0743ece18 108 args[1] = (uint32_t)strlen(new_name);
demayer 0:6bf0743ece18 109 return __semihost(SYS_RENAME, args);
demayer 0:6bf0743ece18 110 }
demayer 0:6bf0743ece18 111 #endif
demayer 0:6bf0743ece18 112
demayer 0:6bf0743ece18 113 int semihost_exit(void) {
demayer 0:6bf0743ece18 114 uint32_t args[4];
demayer 0:6bf0743ece18 115 return __semihost(SYS_EXIT, args);
demayer 0:6bf0743ece18 116 }
demayer 0:6bf0743ece18 117
demayer 0:6bf0743ece18 118 int semihost_uid(char *uid) {
demayer 0:6bf0743ece18 119 uint32_t args[2];
demayer 0:6bf0743ece18 120 args[0] = (uint32_t)uid;
demayer 0:6bf0743ece18 121 args[1] = DEVICE_ID_LENGTH + 1;
demayer 0:6bf0743ece18 122 return __semihost(USR_UID, &args);
demayer 0:6bf0743ece18 123 }
demayer 0:6bf0743ece18 124
demayer 0:6bf0743ece18 125 int semihost_reset(void) {
demayer 0:6bf0743ece18 126 // Does not normally return, however if used with older firmware versions
demayer 0:6bf0743ece18 127 // that do not support this call it will return -1.
demayer 0:6bf0743ece18 128 return __semihost(USR_RESET, NULL);
demayer 0:6bf0743ece18 129 }
demayer 0:6bf0743ece18 130
demayer 0:6bf0743ece18 131 int semihost_vbus(void) {
demayer 0:6bf0743ece18 132 return __semihost(USR_VBUS, NULL);
demayer 0:6bf0743ece18 133 }
demayer 0:6bf0743ece18 134
demayer 0:6bf0743ece18 135 int semihost_powerdown(void) {
demayer 0:6bf0743ece18 136 return __semihost(USR_POWERDOWN, NULL);
demayer 0:6bf0743ece18 137 }
demayer 0:6bf0743ece18 138
demayer 0:6bf0743ece18 139 #if DEVICE_DEBUG_AWARENESS
demayer 0:6bf0743ece18 140
demayer 0:6bf0743ece18 141 int semihost_connected(void) {
demayer 0:6bf0743ece18 142 return (CoreDebug->DHCSR & CoreDebug_DHCSR_C_DEBUGEN_Msk) ? 1 : 0;
demayer 0:6bf0743ece18 143 }
demayer 0:6bf0743ece18 144
demayer 0:6bf0743ece18 145 #else
demayer 0:6bf0743ece18 146 // These processors cannot know if the interface is connect, assume so:
demayer 0:6bf0743ece18 147 static int is_debugger_attached = 1;
demayer 0:6bf0743ece18 148
demayer 0:6bf0743ece18 149 int semihost_connected(void) {
demayer 0:6bf0743ece18 150 return is_debugger_attached;
demayer 0:6bf0743ece18 151 }
demayer 0:6bf0743ece18 152 #endif
demayer 0:6bf0743ece18 153
demayer 0:6bf0743ece18 154 int semihost_disabledebug(void) {
demayer 0:6bf0743ece18 155 uint32_t args[1];
demayer 0:6bf0743ece18 156 #if !(DEVICE_DEBUG_AWARENESS)
demayer 0:6bf0743ece18 157 is_debugger_attached = 0;
demayer 0:6bf0743ece18 158 #endif
demayer 0:6bf0743ece18 159 return __semihost(USR_DISABLEDEBUG, &args);
demayer 0:6bf0743ece18 160 }
demayer 0:6bf0743ece18 161
demayer 0:6bf0743ece18 162 #endif
demayer 0:6bf0743ece18 163