Mouse code for the MacroRat

Dependencies:   ITG3200 QEI

Committer:
sahilmgandhi
Date:
Sat Jun 03 00:22:44 2017 +0000
Revision:
46:b156ef445742
Parent:
18:6a4db94011d3
Final code for internal battlebot competition.

Who changed what in which revision?

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