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