The prosthetic control(MIT)

Committer:
ganlikun
Date:
Thu Jun 23 05:23:34 2022 +0000
Revision:
0:20e0c61e0684
01

Who changed what in which revision?

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