EL4121 Embedded System / mbed-os

mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

drivers/BusInOut.cpp@0:b74591d5ab33, 2017-12-11 (annotated)

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 "drivers/BusInOut.h"
be_bryan 0:b74591d5ab33 17 #include "platform/mbed_assert.h"
be_bryan 0:b74591d5ab33 18
be_bryan 0:b74591d5ab33 19 namespace mbed {
be_bryan 0:b74591d5ab33 20
be_bryan 0:b74591d5ab33 21 BusInOut::BusInOut(PinName p0, PinName p1, PinName p2, PinName p3, PinName p4, PinName p5, PinName p6, PinName p7, PinName p8, PinName p9, PinName p10, PinName p11, PinName p12, PinName p13, PinName p14, PinName p15) {
be_bryan 0:b74591d5ab33 22 PinName pins[16] = {p0, p1, p2, p3, p4, p5, p6, p7, p8, p9, p10, p11, p12, p13, p14, p15};
be_bryan 0:b74591d5ab33 23
be_bryan 0:b74591d5ab33 24 // No lock needed in the constructor
be_bryan 0:b74591d5ab33 25 _nc_mask = 0;
be_bryan 0:b74591d5ab33 26 for (int i=0; i<16; i++) {
be_bryan 0:b74591d5ab33 27 _pin[i] = (pins[i] != NC) ? new DigitalInOut(pins[i]) : 0;
be_bryan 0:b74591d5ab33 28 if (pins[i] != NC) {
be_bryan 0:b74591d5ab33 29 _nc_mask |= (1 << i);
be_bryan 0:b74591d5ab33 30 }
be_bryan 0:b74591d5ab33 31 }
be_bryan 0:b74591d5ab33 32 }
be_bryan 0:b74591d5ab33 33
be_bryan 0:b74591d5ab33 34 BusInOut::BusInOut(PinName pins[16]) {
be_bryan 0:b74591d5ab33 35 // No lock needed in the constructor
be_bryan 0:b74591d5ab33 36 _nc_mask = 0;
be_bryan 0:b74591d5ab33 37 for (int i=0; i<16; i++) {
be_bryan 0:b74591d5ab33 38 _pin[i] = (pins[i] != NC) ? new DigitalInOut(pins[i]) : 0;
be_bryan 0:b74591d5ab33 39 if (pins[i] != NC) {
be_bryan 0:b74591d5ab33 40 _nc_mask |= (1 << i);
be_bryan 0:b74591d5ab33 41 }
be_bryan 0:b74591d5ab33 42 }
be_bryan 0:b74591d5ab33 43 }
be_bryan 0:b74591d5ab33 44
be_bryan 0:b74591d5ab33 45 BusInOut::~BusInOut() {
be_bryan 0:b74591d5ab33 46 // No lock needed in the destructor
be_bryan 0:b74591d5ab33 47 for (int i=0; i<16; i++) {
be_bryan 0:b74591d5ab33 48 if (_pin[i] != 0) {
be_bryan 0:b74591d5ab33 49 delete _pin[i];
be_bryan 0:b74591d5ab33 50 }
be_bryan 0:b74591d5ab33 51 }
be_bryan 0:b74591d5ab33 52 }
be_bryan 0:b74591d5ab33 53
be_bryan 0:b74591d5ab33 54 void BusInOut::write(int value) {
be_bryan 0:b74591d5ab33 55 lock();
be_bryan 0:b74591d5ab33 56 for (int i=0; i<16; i++) {
be_bryan 0:b74591d5ab33 57 if (_pin[i] != 0) {
be_bryan 0:b74591d5ab33 58 _pin[i]->write((value >> i) & 1);
be_bryan 0:b74591d5ab33 59 }
be_bryan 0:b74591d5ab33 60 }
be_bryan 0:b74591d5ab33 61 unlock();
be_bryan 0:b74591d5ab33 62 }
be_bryan 0:b74591d5ab33 63
be_bryan 0:b74591d5ab33 64 int BusInOut::read() {
be_bryan 0:b74591d5ab33 65 lock();
be_bryan 0:b74591d5ab33 66 int v = 0;
be_bryan 0:b74591d5ab33 67 for (int i=0; i<16; i++) {
be_bryan 0:b74591d5ab33 68 if (_pin[i] != 0) {
be_bryan 0:b74591d5ab33 69 v |= _pin[i]->read() << i;
be_bryan 0:b74591d5ab33 70 }
be_bryan 0:b74591d5ab33 71 }
be_bryan 0:b74591d5ab33 72 unlock();
be_bryan 0:b74591d5ab33 73 return v;
be_bryan 0:b74591d5ab33 74 }
be_bryan 0:b74591d5ab33 75
be_bryan 0:b74591d5ab33 76 void BusInOut::output() {
be_bryan 0:b74591d5ab33 77 lock();
be_bryan 0:b74591d5ab33 78 for (int i=0; i<16; i++) {
be_bryan 0:b74591d5ab33 79 if (_pin[i] != 0) {
be_bryan 0:b74591d5ab33 80 _pin[i]->output();
be_bryan 0:b74591d5ab33 81 }
be_bryan 0:b74591d5ab33 82 }
be_bryan 0:b74591d5ab33 83 unlock();
be_bryan 0:b74591d5ab33 84 }
be_bryan 0:b74591d5ab33 85
be_bryan 0:b74591d5ab33 86 void BusInOut::input() {
be_bryan 0:b74591d5ab33 87 lock();
be_bryan 0:b74591d5ab33 88 for (int i=0; i<16; i++) {
be_bryan 0:b74591d5ab33 89 if (_pin[i] != 0) {
be_bryan 0:b74591d5ab33 90 _pin[i]->input();
be_bryan 0:b74591d5ab33 91 }
be_bryan 0:b74591d5ab33 92 }
be_bryan 0:b74591d5ab33 93 unlock();
be_bryan 0:b74591d5ab33 94 }
be_bryan 0:b74591d5ab33 95
be_bryan 0:b74591d5ab33 96 void BusInOut::mode(PinMode pull) {
be_bryan 0:b74591d5ab33 97 lock();
be_bryan 0:b74591d5ab33 98 for (int i=0; i<16; i++) {
be_bryan 0:b74591d5ab33 99 if (_pin[i] != 0) {
be_bryan 0:b74591d5ab33 100 _pin[i]->mode(pull);
be_bryan 0:b74591d5ab33 101 }
be_bryan 0:b74591d5ab33 102 }
be_bryan 0:b74591d5ab33 103 unlock();
be_bryan 0:b74591d5ab33 104 }
be_bryan 0:b74591d5ab33 105
be_bryan 0:b74591d5ab33 106 BusInOut& BusInOut::operator= (int v) {
be_bryan 0:b74591d5ab33 107 // Underlying write is thread safe
be_bryan 0:b74591d5ab33 108 write(v);
be_bryan 0:b74591d5ab33 109 return *this;
be_bryan 0:b74591d5ab33 110 }
be_bryan 0:b74591d5ab33 111
be_bryan 0:b74591d5ab33 112 BusInOut& BusInOut::operator= (BusInOut& rhs) {
be_bryan 0:b74591d5ab33 113 // Underlying read is thread safe
be_bryan 0:b74591d5ab33 114 write(rhs.read());
be_bryan 0:b74591d5ab33 115 return *this;
be_bryan 0:b74591d5ab33 116 }
be_bryan 0:b74591d5ab33 117
be_bryan 0:b74591d5ab33 118 DigitalInOut& BusInOut::operator[] (int index) {
be_bryan 0:b74591d5ab33 119 // No lock needed since _pin is not modified outside the constructor
be_bryan 0:b74591d5ab33 120 MBED_ASSERT(index >= 0 && index <= 16);
be_bryan 0:b74591d5ab33 121 MBED_ASSERT(_pin[index]);
be_bryan 0:b74591d5ab33 122 return *_pin[index];
be_bryan 0:b74591d5ab33 123 }
be_bryan 0:b74591d5ab33 124
be_bryan 0:b74591d5ab33 125 BusInOut::operator int() {
be_bryan 0:b74591d5ab33 126 // Underlying read is thread safe
be_bryan 0:b74591d5ab33 127 return read();
be_bryan 0:b74591d5ab33 128 }
be_bryan 0:b74591d5ab33 129
be_bryan 0:b74591d5ab33 130 void BusInOut::lock() {
be_bryan 0:b74591d5ab33 131 _mutex.lock();
be_bryan 0:b74591d5ab33 132 }
be_bryan 0:b74591d5ab33 133
be_bryan 0:b74591d5ab33 134 void BusInOut::unlock() {
be_bryan 0:b74591d5ab33 135 _mutex.unlock();
be_bryan 0:b74591d5ab33 136 }
be_bryan 0:b74591d5ab33 137
be_bryan 0:b74591d5ab33 138 } // namespace mbed