107 lines
3.2 KiB
C++
107 lines
3.2 KiB
C++
/******************************************************************************
|
|
* The MIT License
|
|
*
|
|
* Copyright (c) 2010 LeafLabs LLC.
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person
|
|
* obtaining a copy of this software and associated documentation
|
|
* files (the "Software"), to deal in the Software without
|
|
* restriction, including without limitation the rights to use, copy,
|
|
* modify, merge, publish, distribute, sublicense, and/or sell copies
|
|
* of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be
|
|
* included in all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
|
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
|
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
|
|
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
|
|
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
|
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
* SOFTWARE.
|
|
*****************************************************************************/
|
|
|
|
/**
|
|
* @file TwoWire.cpp
|
|
* @author Trystan Jones <crenn6977@gmail.com>
|
|
* @brief Wire library, uses the hardware I2C available in the Maple to
|
|
* interact with I2C slave devices.
|
|
*/
|
|
|
|
/*
|
|
* Library created by crenn to use the new WireBase system and allow Arduino
|
|
* users easy interaction with the I2C Hardware in a familiar method.
|
|
*/
|
|
|
|
#include "Wire.h"
|
|
|
|
uint8 TwoWire::process(uint8 stop) {
|
|
int8 res = i2c_master_xfer(sel_hard, &itc_msg, 1, 0);
|
|
if (res == I2C_ERROR_PROTOCOL) {
|
|
if (sel_hard->error_flags & I2C_SR1_AF) { /* NACK */
|
|
res = (sel_hard->error_flags & I2C_SR1_ADDR ? ENACKADDR :
|
|
ENACKTRNS);
|
|
} else if (sel_hard->error_flags & I2C_SR1_OVR) { /* Over/Underrun */
|
|
res = EDATA;
|
|
} else { /* Bus or Arbitration error */
|
|
res = EOTHER;
|
|
}
|
|
i2c_disable(sel_hard);
|
|
i2c_master_enable(sel_hard, (I2C_BUS_RESET | dev_flags));
|
|
}
|
|
return res;
|
|
}
|
|
|
|
uint8 TwoWire::process(){
|
|
return process(true);
|
|
}
|
|
|
|
// TODO: Add in Error Handling if devsel is out of range for other Maples
|
|
TwoWire::TwoWire(uint8 dev_sel, uint8 flags) {
|
|
if (dev_sel == 1) {
|
|
sel_hard = I2C1;
|
|
} else if (dev_sel == 2) {
|
|
sel_hard = I2C2;
|
|
} else {
|
|
ASSERT(1);
|
|
}
|
|
dev_flags = flags;
|
|
}
|
|
|
|
TwoWire::~TwoWire() {
|
|
i2c_disable(sel_hard);
|
|
sel_hard = 0;
|
|
}
|
|
|
|
void TwoWire::begin(uint8 self_addr) {
|
|
i2c_master_enable(sel_hard, dev_flags);
|
|
}
|
|
|
|
void TwoWire::end() {
|
|
i2c_disable(sel_hard);
|
|
sel_hard = 0;
|
|
}
|
|
|
|
void TwoWire::setClock(uint32_t frequencyHz)
|
|
{
|
|
switch(frequencyHz)
|
|
{
|
|
case 400000:
|
|
dev_flags |= I2C_FAST_MODE;// set FAST_MODE bit
|
|
break;
|
|
case 100000:
|
|
default:
|
|
dev_flags &= ~I2C_FAST_MODE;// clear FAST_MODE bit
|
|
break;
|
|
}
|
|
if (sel_hard->regs->CR1 & I2C_CR1_PE){
|
|
i2c_disable(sel_hard);
|
|
i2c_master_enable(sel_hard, dev_flags);
|
|
}
|
|
}
|
|
|
|
TwoWire Wire(1);
|