mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

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