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-2015 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/I2C.h"
sahilmgandhi 18:6a4db94011d3 17
sahilmgandhi 18:6a4db94011d3 18 #if DEVICE_I2C
sahilmgandhi 18:6a4db94011d3 19
sahilmgandhi 18:6a4db94011d3 20 namespace mbed {
sahilmgandhi 18:6a4db94011d3 21
sahilmgandhi 18:6a4db94011d3 22 I2C *I2C::_owner = NULL;
sahilmgandhi 18:6a4db94011d3 23 SingletonPtr<PlatformMutex> I2C::_mutex;
sahilmgandhi 18:6a4db94011d3 24
sahilmgandhi 18:6a4db94011d3 25 I2C::I2C(PinName sda, PinName scl) :
sahilmgandhi 18:6a4db94011d3 26 #if DEVICE_I2C_ASYNCH
sahilmgandhi 18:6a4db94011d3 27 _irq(this), _usage(DMA_USAGE_NEVER),
sahilmgandhi 18:6a4db94011d3 28 #endif
sahilmgandhi 18:6a4db94011d3 29 _i2c(), _hz(100000) {
sahilmgandhi 18:6a4db94011d3 30 // No lock needed in the constructor
sahilmgandhi 18:6a4db94011d3 31
sahilmgandhi 18:6a4db94011d3 32 // The init function also set the frequency to 100000
sahilmgandhi 18:6a4db94011d3 33 i2c_init(&_i2c, sda, scl);
sahilmgandhi 18:6a4db94011d3 34
sahilmgandhi 18:6a4db94011d3 35 // Used to avoid unnecessary frequency updates
sahilmgandhi 18:6a4db94011d3 36 _owner = this;
sahilmgandhi 18:6a4db94011d3 37 }
sahilmgandhi 18:6a4db94011d3 38
sahilmgandhi 18:6a4db94011d3 39 void I2C::frequency(int hz) {
sahilmgandhi 18:6a4db94011d3 40 lock();
sahilmgandhi 18:6a4db94011d3 41 _hz = hz;
sahilmgandhi 18:6a4db94011d3 42
sahilmgandhi 18:6a4db94011d3 43 // We want to update the frequency even if we are already the bus owners
sahilmgandhi 18:6a4db94011d3 44 i2c_frequency(&_i2c, _hz);
sahilmgandhi 18:6a4db94011d3 45
sahilmgandhi 18:6a4db94011d3 46 // Updating the frequency of the bus we become the owners of it
sahilmgandhi 18:6a4db94011d3 47 _owner = this;
sahilmgandhi 18:6a4db94011d3 48 unlock();
sahilmgandhi 18:6a4db94011d3 49 }
sahilmgandhi 18:6a4db94011d3 50
sahilmgandhi 18:6a4db94011d3 51 void I2C::aquire() {
sahilmgandhi 18:6a4db94011d3 52 lock();
sahilmgandhi 18:6a4db94011d3 53 if (_owner != this) {
sahilmgandhi 18:6a4db94011d3 54 i2c_frequency(&_i2c, _hz);
sahilmgandhi 18:6a4db94011d3 55 _owner = this;
sahilmgandhi 18:6a4db94011d3 56 }
sahilmgandhi 18:6a4db94011d3 57 unlock();
sahilmgandhi 18:6a4db94011d3 58 }
sahilmgandhi 18:6a4db94011d3 59
sahilmgandhi 18:6a4db94011d3 60 // write - Master Transmitter Mode
sahilmgandhi 18:6a4db94011d3 61 int I2C::write(int address, const char* data, int length, bool repeated) {
sahilmgandhi 18:6a4db94011d3 62 lock();
sahilmgandhi 18:6a4db94011d3 63 aquire();
sahilmgandhi 18:6a4db94011d3 64
sahilmgandhi 18:6a4db94011d3 65 int stop = (repeated) ? 0 : 1;
sahilmgandhi 18:6a4db94011d3 66 int written = i2c_write(&_i2c, address, data, length, stop);
sahilmgandhi 18:6a4db94011d3 67
sahilmgandhi 18:6a4db94011d3 68 unlock();
sahilmgandhi 18:6a4db94011d3 69 return length != written;
sahilmgandhi 18:6a4db94011d3 70 }
sahilmgandhi 18:6a4db94011d3 71
sahilmgandhi 18:6a4db94011d3 72 int I2C::write(int data) {
sahilmgandhi 18:6a4db94011d3 73 lock();
sahilmgandhi 18:6a4db94011d3 74 int ret = i2c_byte_write(&_i2c, data);
sahilmgandhi 18:6a4db94011d3 75 unlock();
sahilmgandhi 18:6a4db94011d3 76 return ret;
sahilmgandhi 18:6a4db94011d3 77 }
sahilmgandhi 18:6a4db94011d3 78
sahilmgandhi 18:6a4db94011d3 79 // read - Master Reciever Mode
sahilmgandhi 18:6a4db94011d3 80 int I2C::read(int address, char* data, int length, bool repeated) {
sahilmgandhi 18:6a4db94011d3 81 lock();
sahilmgandhi 18:6a4db94011d3 82 aquire();
sahilmgandhi 18:6a4db94011d3 83
sahilmgandhi 18:6a4db94011d3 84 int stop = (repeated) ? 0 : 1;
sahilmgandhi 18:6a4db94011d3 85 int read = i2c_read(&_i2c, address, data, length, stop);
sahilmgandhi 18:6a4db94011d3 86
sahilmgandhi 18:6a4db94011d3 87 unlock();
sahilmgandhi 18:6a4db94011d3 88 return length != read;
sahilmgandhi 18:6a4db94011d3 89 }
sahilmgandhi 18:6a4db94011d3 90
sahilmgandhi 18:6a4db94011d3 91 int I2C::read(int ack) {
sahilmgandhi 18:6a4db94011d3 92 lock();
sahilmgandhi 18:6a4db94011d3 93 int ret;
sahilmgandhi 18:6a4db94011d3 94 if (ack) {
sahilmgandhi 18:6a4db94011d3 95 ret = i2c_byte_read(&_i2c, 0);
sahilmgandhi 18:6a4db94011d3 96 } else {
sahilmgandhi 18:6a4db94011d3 97 ret = i2c_byte_read(&_i2c, 1);
sahilmgandhi 18:6a4db94011d3 98 }
sahilmgandhi 18:6a4db94011d3 99 unlock();
sahilmgandhi 18:6a4db94011d3 100 return ret;
sahilmgandhi 18:6a4db94011d3 101 }
sahilmgandhi 18:6a4db94011d3 102
sahilmgandhi 18:6a4db94011d3 103 void I2C::start(void) {
sahilmgandhi 18:6a4db94011d3 104 lock();
sahilmgandhi 18:6a4db94011d3 105 i2c_start(&_i2c);
sahilmgandhi 18:6a4db94011d3 106 unlock();
sahilmgandhi 18:6a4db94011d3 107 }
sahilmgandhi 18:6a4db94011d3 108
sahilmgandhi 18:6a4db94011d3 109 void I2C::stop(void) {
sahilmgandhi 18:6a4db94011d3 110 lock();
sahilmgandhi 18:6a4db94011d3 111 i2c_stop(&_i2c);
sahilmgandhi 18:6a4db94011d3 112 unlock();
sahilmgandhi 18:6a4db94011d3 113 }
sahilmgandhi 18:6a4db94011d3 114
sahilmgandhi 18:6a4db94011d3 115 void I2C::lock() {
sahilmgandhi 18:6a4db94011d3 116 _mutex->lock();
sahilmgandhi 18:6a4db94011d3 117 }
sahilmgandhi 18:6a4db94011d3 118
sahilmgandhi 18:6a4db94011d3 119 void I2C::unlock() {
sahilmgandhi 18:6a4db94011d3 120 _mutex->unlock();
sahilmgandhi 18:6a4db94011d3 121 }
sahilmgandhi 18:6a4db94011d3 122
sahilmgandhi 18:6a4db94011d3 123 #if DEVICE_I2C_ASYNCH
sahilmgandhi 18:6a4db94011d3 124
sahilmgandhi 18:6a4db94011d3 125 int I2C::transfer(int address, const char *tx_buffer, int tx_length, char *rx_buffer, int rx_length, const event_callback_t& callback, int event, bool repeated)
sahilmgandhi 18:6a4db94011d3 126 {
sahilmgandhi 18:6a4db94011d3 127 lock();
sahilmgandhi 18:6a4db94011d3 128 if (i2c_active(&_i2c)) {
sahilmgandhi 18:6a4db94011d3 129 unlock();
sahilmgandhi 18:6a4db94011d3 130 return -1; // transaction ongoing
sahilmgandhi 18:6a4db94011d3 131 }
sahilmgandhi 18:6a4db94011d3 132 aquire();
sahilmgandhi 18:6a4db94011d3 133
sahilmgandhi 18:6a4db94011d3 134 _callback = callback;
sahilmgandhi 18:6a4db94011d3 135 int stop = (repeated) ? 0 : 1;
sahilmgandhi 18:6a4db94011d3 136 _irq.callback(&I2C::irq_handler_asynch);
sahilmgandhi 18:6a4db94011d3 137 i2c_transfer_asynch(&_i2c, (void *)tx_buffer, tx_length, (void *)rx_buffer, rx_length, address, stop, _irq.entry(), event, _usage);
sahilmgandhi 18:6a4db94011d3 138 unlock();
sahilmgandhi 18:6a4db94011d3 139 return 0;
sahilmgandhi 18:6a4db94011d3 140 }
sahilmgandhi 18:6a4db94011d3 141
sahilmgandhi 18:6a4db94011d3 142 void I2C::abort_transfer(void)
sahilmgandhi 18:6a4db94011d3 143 {
sahilmgandhi 18:6a4db94011d3 144 lock();
sahilmgandhi 18:6a4db94011d3 145 i2c_abort_asynch(&_i2c);
sahilmgandhi 18:6a4db94011d3 146 unlock();
sahilmgandhi 18:6a4db94011d3 147 }
sahilmgandhi 18:6a4db94011d3 148
sahilmgandhi 18:6a4db94011d3 149 void I2C::irq_handler_asynch(void)
sahilmgandhi 18:6a4db94011d3 150 {
sahilmgandhi 18:6a4db94011d3 151 int event = i2c_irq_handler_asynch(&_i2c);
sahilmgandhi 18:6a4db94011d3 152 if (_callback && event) {
sahilmgandhi 18:6a4db94011d3 153 _callback.call(event);
sahilmgandhi 18:6a4db94011d3 154 }
sahilmgandhi 18:6a4db94011d3 155
sahilmgandhi 18:6a4db94011d3 156 }
sahilmgandhi 18:6a4db94011d3 157
sahilmgandhi 18:6a4db94011d3 158
sahilmgandhi 18:6a4db94011d3 159 #endif
sahilmgandhi 18:6a4db94011d3 160
sahilmgandhi 18:6a4db94011d3 161 } // namespace mbed
sahilmgandhi 18:6a4db94011d3 162
sahilmgandhi 18:6a4db94011d3 163 #endif