Bogdan Marinescu / kl25z-i2c-fix

Tentative KL25Z I2C HAL fix

Fork of mbed-src by mbed official

common/BusOut.cpp@10:3bc89ef62ce7, 2013-06-14 (annotated)

Committer:
emilmont
Date:
Fri Jun 14 17:49:17 2013 +0100
Revision:
10:3bc89ef62ce7
Parent:
9:0ce32e54c9a7
Child:
13:0645d8841f51
Unify mbed library sources

Who changed what in which revision?

UserRevisionLine numberNew contents of line
emilmont 10:3bc89ef62ce7 1 /* mbed Microcontroller Library
emilmont 10:3bc89ef62ce7 2 * Copyright (c) 2006-2013 ARM Limited
emilmont 10:3bc89ef62ce7 3 *
emilmont 10:3bc89ef62ce7 4 * Licensed under the Apache License, Version 2.0 (the "License");
emilmont 10:3bc89ef62ce7 5 * you may not use this file except in compliance with the License.
emilmont 10:3bc89ef62ce7 6 * You may obtain a copy of the License at
emilmont 10:3bc89ef62ce7 7 *
emilmont 10:3bc89ef62ce7 8 * http://www.apache.org/licenses/LICENSE-2.0
emilmont 10:3bc89ef62ce7 9 *
emilmont 10:3bc89ef62ce7 10 * Unless required by applicable law or agreed to in writing, software
emilmont 10:3bc89ef62ce7 11 * distributed under the License is distributed on an "AS IS" BASIS,
emilmont 10:3bc89ef62ce7 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
emilmont 10:3bc89ef62ce7 13 * See the License for the specific language governing permissions and
emilmont 10:3bc89ef62ce7 14 * limitations under the License.
emilmont 10:3bc89ef62ce7 15 */
emilmont 10:3bc89ef62ce7 16 #include "BusOut.h"
emilmont 10:3bc89ef62ce7 17
emilmont 10:3bc89ef62ce7 18 namespace mbed {
emilmont 10:3bc89ef62ce7 19
emilmont 10:3bc89ef62ce7 20 BusOut::BusOut(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) {
emilmont 10:3bc89ef62ce7 21 PinName pins[16] = {p0, p1, p2, p3, p4, p5, p6, p7, p8, p9, p10, p11, p12, p13, p14, p15};
emilmont 10:3bc89ef62ce7 22
emilmont 10:3bc89ef62ce7 23 for (int i=0; i<16; i++) {
emilmont 10:3bc89ef62ce7 24 _pin[i] = (pins[i] != NC) ? new DigitalOut(pins[i]) : 0;
emilmont 10:3bc89ef62ce7 25 }
emilmont 10:3bc89ef62ce7 26 }
emilmont 10:3bc89ef62ce7 27
emilmont 10:3bc89ef62ce7 28 BusOut::BusOut(PinName pins[16]) {
emilmont 10:3bc89ef62ce7 29 for (int i=0; i<16; i++) {
emilmont 10:3bc89ef62ce7 30 _pin[i] = (pins[i] != NC) ? new DigitalOut(pins[i]) : 0;
emilmont 10:3bc89ef62ce7 31 }
emilmont 10:3bc89ef62ce7 32 }
emilmont 10:3bc89ef62ce7 33
emilmont 10:3bc89ef62ce7 34 BusOut::~BusOut() {
emilmont 10:3bc89ef62ce7 35 for (int i=0; i<16; i++) {
emilmont 10:3bc89ef62ce7 36 if (_pin[i] != 0) {
emilmont 10:3bc89ef62ce7 37 delete _pin[i];
emilmont 10:3bc89ef62ce7 38 }
emilmont 10:3bc89ef62ce7 39 }
emilmont 10:3bc89ef62ce7 40 }
emilmont 10:3bc89ef62ce7 41
emilmont 10:3bc89ef62ce7 42 void BusOut::write(int value) {
emilmont 10:3bc89ef62ce7 43 for (int i=0; i<16; i++) {
emilmont 10:3bc89ef62ce7 44 if (_pin[i] != 0) {
emilmont 10:3bc89ef62ce7 45 _pin[i]->write((value >> i) & 1);
emilmont 10:3bc89ef62ce7 46 }
emilmont 10:3bc89ef62ce7 47 }
emilmont 10:3bc89ef62ce7 48 }
emilmont 10:3bc89ef62ce7 49
emilmont 10:3bc89ef62ce7 50 int BusOut::read() {
emilmont 10:3bc89ef62ce7 51 int v = 0;
emilmont 10:3bc89ef62ce7 52 for (int i=0; i<16; i++) {
emilmont 10:3bc89ef62ce7 53 if (_pin[i] != 0) {
emilmont 10:3bc89ef62ce7 54 v |= _pin[i]->read() << i;
emilmont 10:3bc89ef62ce7 55 }
emilmont 10:3bc89ef62ce7 56 }
emilmont 10:3bc89ef62ce7 57 return v;
emilmont 10:3bc89ef62ce7 58 }
emilmont 10:3bc89ef62ce7 59
emilmont 10:3bc89ef62ce7 60 #ifdef MBED_OPERATORS
emilmont 10:3bc89ef62ce7 61 BusOut& BusOut::operator= (int v) {
emilmont 10:3bc89ef62ce7 62 write(v);
emilmont 10:3bc89ef62ce7 63 return *this;
emilmont 10:3bc89ef62ce7 64 }
emilmont 10:3bc89ef62ce7 65
emilmont 10:3bc89ef62ce7 66 BusOut& BusOut::operator= (BusOut& rhs) {
emilmont 10:3bc89ef62ce7 67 write(rhs.read());
emilmont 10:3bc89ef62ce7 68 return *this;
emilmont 10:3bc89ef62ce7 69 }
emilmont 10:3bc89ef62ce7 70
emilmont 10:3bc89ef62ce7 71 BusOut::operator int() {
emilmont 10:3bc89ef62ce7 72 return read();
emilmont 10:3bc89ef62ce7 73 }
emilmont 10:3bc89ef62ce7 74 #endif
emilmont 10:3bc89ef62ce7 75
emilmont 10:3bc89ef62ce7 76 } // namespace mbed