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 "drivers/RawSerial.h"
sahilmgandhi 18:6a4db94011d3 17 #include "platform/mbed_wait_api.h"
sahilmgandhi 18:6a4db94011d3 18 #include <cstdarg>
sahilmgandhi 18:6a4db94011d3 19
sahilmgandhi 18:6a4db94011d3 20 #if DEVICE_SERIAL
sahilmgandhi 18:6a4db94011d3 21
sahilmgandhi 18:6a4db94011d3 22 #define STRING_STACK_LIMIT 120
sahilmgandhi 18:6a4db94011d3 23
sahilmgandhi 18:6a4db94011d3 24 namespace mbed {
sahilmgandhi 18:6a4db94011d3 25
sahilmgandhi 18:6a4db94011d3 26 RawSerial::RawSerial(PinName tx, PinName rx, int baud) : SerialBase(tx, rx, baud) {
sahilmgandhi 18:6a4db94011d3 27 // No lock needed in the constructor
sahilmgandhi 18:6a4db94011d3 28 }
sahilmgandhi 18:6a4db94011d3 29
sahilmgandhi 18:6a4db94011d3 30 int RawSerial::getc() {
sahilmgandhi 18:6a4db94011d3 31 lock();
sahilmgandhi 18:6a4db94011d3 32 int ret = _base_getc();
sahilmgandhi 18:6a4db94011d3 33 unlock();
sahilmgandhi 18:6a4db94011d3 34 return ret;
sahilmgandhi 18:6a4db94011d3 35 }
sahilmgandhi 18:6a4db94011d3 36
sahilmgandhi 18:6a4db94011d3 37 int RawSerial::putc(int c) {
sahilmgandhi 18:6a4db94011d3 38 lock();
sahilmgandhi 18:6a4db94011d3 39 int ret = _base_putc(c);
sahilmgandhi 18:6a4db94011d3 40 unlock();
sahilmgandhi 18:6a4db94011d3 41 return ret;
sahilmgandhi 18:6a4db94011d3 42 }
sahilmgandhi 18:6a4db94011d3 43
sahilmgandhi 18:6a4db94011d3 44 int RawSerial::puts(const char *str) {
sahilmgandhi 18:6a4db94011d3 45 lock();
sahilmgandhi 18:6a4db94011d3 46 while (*str)
sahilmgandhi 18:6a4db94011d3 47 putc(*str ++);
sahilmgandhi 18:6a4db94011d3 48 unlock();
sahilmgandhi 18:6a4db94011d3 49 return 0;
sahilmgandhi 18:6a4db94011d3 50 }
sahilmgandhi 18:6a4db94011d3 51
sahilmgandhi 18:6a4db94011d3 52 // Experimental support for printf in RawSerial. No Stream inheritance
sahilmgandhi 18:6a4db94011d3 53 // means we can't call printf() directly, so we use sprintf() instead.
sahilmgandhi 18:6a4db94011d3 54 // We only call malloc() for the sprintf() buffer if the buffer
sahilmgandhi 18:6a4db94011d3 55 // length is above a certain threshold, otherwise we use just the stack.
sahilmgandhi 18:6a4db94011d3 56 int RawSerial::printf(const char *format, ...) {
sahilmgandhi 18:6a4db94011d3 57 lock();
sahilmgandhi 18:6a4db94011d3 58 std::va_list arg;
sahilmgandhi 18:6a4db94011d3 59 va_start(arg, format);
sahilmgandhi 18:6a4db94011d3 60 // ARMCC microlib does not properly handle a size of 0.
sahilmgandhi 18:6a4db94011d3 61 // As a workaround supply a dummy buffer with a size of 1.
sahilmgandhi 18:6a4db94011d3 62 char dummy_buf[1];
sahilmgandhi 18:6a4db94011d3 63 int len = vsnprintf(dummy_buf, sizeof(dummy_buf), format, arg);
sahilmgandhi 18:6a4db94011d3 64 if (len < STRING_STACK_LIMIT) {
sahilmgandhi 18:6a4db94011d3 65 char temp[STRING_STACK_LIMIT];
sahilmgandhi 18:6a4db94011d3 66 vsprintf(temp, format, arg);
sahilmgandhi 18:6a4db94011d3 67 puts(temp);
sahilmgandhi 18:6a4db94011d3 68 } else {
sahilmgandhi 18:6a4db94011d3 69 char *temp = new char[len + 1];
sahilmgandhi 18:6a4db94011d3 70 vsprintf(temp, format, arg);
sahilmgandhi 18:6a4db94011d3 71 puts(temp);
sahilmgandhi 18:6a4db94011d3 72 delete[] temp;
sahilmgandhi 18:6a4db94011d3 73 }
sahilmgandhi 18:6a4db94011d3 74 va_end(arg);
sahilmgandhi 18:6a4db94011d3 75 unlock();
sahilmgandhi 18:6a4db94011d3 76 return len;
sahilmgandhi 18:6a4db94011d3 77 }
sahilmgandhi 18:6a4db94011d3 78
sahilmgandhi 18:6a4db94011d3 79 /** Acquire exclusive access to this serial port
sahilmgandhi 18:6a4db94011d3 80 */
sahilmgandhi 18:6a4db94011d3 81 void RawSerial::lock() {
sahilmgandhi 18:6a4db94011d3 82 // No lock used - external synchronization required
sahilmgandhi 18:6a4db94011d3 83 }
sahilmgandhi 18:6a4db94011d3 84
sahilmgandhi 18:6a4db94011d3 85 /** Release exclusive access to this serial port
sahilmgandhi 18:6a4db94011d3 86 */
sahilmgandhi 18:6a4db94011d3 87 void RawSerial::unlock() {
sahilmgandhi 18:6a4db94011d3 88 // No lock used - external synchronization required
sahilmgandhi 18:6a4db94011d3 89 }
sahilmgandhi 18:6a4db94011d3 90
sahilmgandhi 18:6a4db94011d3 91 } // namespace mbed
sahilmgandhi 18:6a4db94011d3 92
sahilmgandhi 18:6a4db94011d3 93 #endif