Thomas Moore
7 years ago
committed by
Scott Lahteine
Scott Lahteine
3 changed files with 274 additions and 25 deletions
@ -0,0 +1,238 @@ |
|||||
|
/*
|
||||
|
TwoWire.cpp - TWI/I2C library for Wiring & Arduino |
||||
|
Copyright (c) 2006 Nicholas Zambetti. All right reserved. |
||||
|
|
||||
|
This library is free software; you can redistribute it and/or |
||||
|
modify it under the terms of the GNU Lesser General Public |
||||
|
License as published by the Free Software Foundation; either |
||||
|
version 2.1 of the License, or (at your option) any later version. |
||||
|
|
||||
|
This library is distributed in the hope that it will be useful, |
||||
|
but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
||||
|
Lesser General Public License for more details. |
||||
|
|
||||
|
You should have received a copy of the GNU Lesser General Public |
||||
|
License along with this library; if not, write to the Free Software |
||||
|
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
||||
|
*/ |
||||
|
|
||||
|
#ifdef TARGET_LPC1768 |
||||
|
|
||||
|
extern "C" { |
||||
|
#include <stdlib.h> |
||||
|
#include <string.h> |
||||
|
#include <inttypes.h> |
||||
|
#include <lpc17xx_i2c.h> |
||||
|
#include <lpc17xx_pinsel.h> |
||||
|
#include <lpc17xx_libcfg_default.h> |
||||
|
} |
||||
|
|
||||
|
#include "Wire.h" |
||||
|
|
||||
|
#define USEDI2CDEV_M 1 |
||||
|
|
||||
|
#if (USEDI2CDEV_M == 0) |
||||
|
#define I2CDEV_M LPC_I2C0 |
||||
|
#elif (USEDI2CDEV_M == 1) |
||||
|
#define I2CDEV_M LPC_I2C1 |
||||
|
#elif (USEDI2CDEV_M == 2) |
||||
|
#define I2CDEV_M LPC_I2C2 |
||||
|
#else |
||||
|
#error "Master I2C device not defined!" |
||||
|
#endif |
||||
|
|
||||
|
// Initialize Class Variables //////////////////////////////////////////////////
|
||||
|
|
||||
|
uint8_t TwoWire::rxBuffer[BUFFER_LENGTH]; |
||||
|
uint8_t TwoWire::rxBufferIndex = 0; |
||||
|
uint8_t TwoWire::rxBufferLength = 0; |
||||
|
|
||||
|
uint8_t TwoWire::txAddress = 0; |
||||
|
uint8_t TwoWire::txBuffer[BUFFER_LENGTH]; |
||||
|
uint8_t TwoWire::txBufferIndex = 0; |
||||
|
uint8_t TwoWire::txBufferLength = 0; |
||||
|
|
||||
|
uint8_t TwoWire::transmitting = 0; |
||||
|
|
||||
|
// Constructors ////////////////////////////////////////////////////////////////
|
||||
|
|
||||
|
TwoWire::TwoWire() { |
||||
|
} |
||||
|
|
||||
|
// Public Methods //////////////////////////////////////////////////////////////
|
||||
|
|
||||
|
void TwoWire::begin(void) { |
||||
|
rxBufferIndex = 0; |
||||
|
rxBufferLength = 0; |
||||
|
|
||||
|
txBufferIndex = 0; |
||||
|
txBufferLength = 0; |
||||
|
|
||||
|
/*
|
||||
|
* Init I2C pin connect |
||||
|
*/ |
||||
|
PINSEL_CFG_Type PinCfg; |
||||
|
PinCfg.OpenDrain = 0; |
||||
|
PinCfg.Pinmode = 0; |
||||
|
#if ((USEDI2CDEV_M == 0)) |
||||
|
PinCfg.Funcnum = 1; |
||||
|
PinCfg.Pinnum = 27; |
||||
|
PinCfg.Portnum = 0; |
||||
|
PINSEL_ConfigPin(&PinCfg); // SDA0 / D57 AUX-1
|
||||
|
PinCfg.Pinnum = 28; |
||||
|
PINSEL_ConfigPin(&PinCfg); // SCL0 / D58 AUX-1
|
||||
|
#endif |
||||
|
#if ((USEDI2CDEV_M == 1)) |
||||
|
PinCfg.Funcnum = 3; |
||||
|
PinCfg.Pinnum = 0; |
||||
|
PinCfg.Portnum = 0; |
||||
|
PINSEL_ConfigPin(&PinCfg); // SDA1 / D20 SCA
|
||||
|
PinCfg.Pinnum = 1; |
||||
|
PINSEL_ConfigPin(&PinCfg); // SCL1 / D21 SCL
|
||||
|
#endif |
||||
|
#if ((USEDI2CDEV_M == 2)) |
||||
|
PinCfg.Funcnum = 2; |
||||
|
PinCfg.Pinnum = 10; |
||||
|
PinCfg.Portnum = 0; |
||||
|
PINSEL_ConfigPin(&PinCfg); // SDA2 / D38 X_ENABLE_PIN
|
||||
|
PinCfg.Pinnum = 11; |
||||
|
PINSEL_ConfigPin(&PinCfg); // SCL2 / D55 X_DIR_PIN
|
||||
|
#endif |
||||
|
|
||||
|
// Initialize I2C peripheral
|
||||
|
I2C_Init(I2CDEV_M, 100000); |
||||
|
|
||||
|
// Enable Master I2C operation
|
||||
|
I2C_Cmd(I2CDEV_M, I2C_MASTER_MODE, ENABLE); |
||||
|
} |
||||
|
|
||||
|
uint8_t TwoWire::requestFrom(uint8_t address, uint8_t quantity) { |
||||
|
// clamp to buffer length
|
||||
|
if(quantity > BUFFER_LENGTH){ |
||||
|
quantity = BUFFER_LENGTH; |
||||
|
} |
||||
|
|
||||
|
// perform blocking read into buffer
|
||||
|
I2C_M_SETUP_Type transferMCfg; |
||||
|
transferMCfg.sl_addr7bit = address >> 1; // not sure about the right shift
|
||||
|
transferMCfg.tx_data = NULL; |
||||
|
transferMCfg.tx_length = 0; |
||||
|
transferMCfg.rx_data = rxBuffer; |
||||
|
transferMCfg.rx_length = quantity; |
||||
|
transferMCfg.retransmissions_max = 3; |
||||
|
I2C_MasterTransferData(I2CDEV_M, &transferMCfg, I2C_TRANSFER_POLLING); |
||||
|
|
||||
|
// set rx buffer iterator vars
|
||||
|
rxBufferIndex = 0; |
||||
|
rxBufferLength = transferMCfg.rx_count; |
||||
|
|
||||
|
return transferMCfg.rx_count; |
||||
|
} |
||||
|
|
||||
|
uint8_t TwoWire::requestFrom(int address, int quantity) { |
||||
|
return requestFrom((uint8_t)address, (uint8_t)quantity); |
||||
|
} |
||||
|
|
||||
|
void TwoWire::beginTransmission(uint8_t address) { |
||||
|
// indicate that we are transmitting
|
||||
|
transmitting = 1; |
||||
|
// set address of targeted slave
|
||||
|
txAddress = address; |
||||
|
// reset tx buffer iterator vars
|
||||
|
txBufferIndex = 0; |
||||
|
txBufferLength = 0; |
||||
|
} |
||||
|
|
||||
|
void TwoWire::beginTransmission(int address) { |
||||
|
beginTransmission((uint8_t)address); |
||||
|
} |
||||
|
|
||||
|
uint8_t TwoWire::endTransmission(void) { |
||||
|
// transmit buffer (blocking)
|
||||
|
I2C_M_SETUP_Type transferMCfg; |
||||
|
transferMCfg.sl_addr7bit = txAddress >> 1; // not sure about the right shift
|
||||
|
transferMCfg.tx_data = txBuffer; |
||||
|
transferMCfg.tx_length = txBufferLength; |
||||
|
transferMCfg.rx_data = NULL; |
||||
|
transferMCfg.rx_length = 0; |
||||
|
transferMCfg.retransmissions_max = 3; |
||||
|
Status status = I2C_MasterTransferData(I2CDEV_M, &transferMCfg, I2C_TRANSFER_POLLING); |
||||
|
|
||||
|
// reset tx buffer iterator vars
|
||||
|
txBufferIndex = 0; |
||||
|
txBufferLength = 0; |
||||
|
|
||||
|
// indicate that we are done transmitting
|
||||
|
transmitting = 0; |
||||
|
|
||||
|
if (status == SUCCESS) |
||||
|
return 0; // success
|
||||
|
else |
||||
|
return 4; // other error
|
||||
|
} |
||||
|
|
||||
|
// must be called after beginTransmission(address)
|
||||
|
size_t TwoWire::write(uint8_t data) { |
||||
|
if (transmitting) { |
||||
|
// don't bother if buffer is full
|
||||
|
if (txBufferLength >= BUFFER_LENGTH) { |
||||
|
return 0; |
||||
|
} |
||||
|
|
||||
|
// put byte in tx buffer
|
||||
|
txBuffer[txBufferIndex] = data; |
||||
|
++txBufferIndex; |
||||
|
|
||||
|
// update amount in buffer
|
||||
|
txBufferLength = txBufferIndex; |
||||
|
} |
||||
|
|
||||
|
return 1; |
||||
|
} |
||||
|
|
||||
|
// must be called after beginTransmission(address)
|
||||
|
size_t TwoWire::write(const uint8_t *data, size_t quantity) { |
||||
|
size_t sent = 0; |
||||
|
if (transmitting) |
||||
|
for(sent = 0; sent < quantity; ++sent) |
||||
|
if (!write(data[sent])) |
||||
|
break; |
||||
|
|
||||
|
return sent; |
||||
|
} |
||||
|
|
||||
|
// must be called after requestFrom(address, numBytes)
|
||||
|
int TwoWire::available(void) { |
||||
|
return rxBufferLength - rxBufferIndex; |
||||
|
} |
||||
|
|
||||
|
// must be called after requestFrom(address, numBytes)
|
||||
|
int TwoWire::read(void) { |
||||
|
int value = -1; |
||||
|
|
||||
|
// get each successive byte on each call
|
||||
|
if(rxBufferIndex < rxBufferLength) { |
||||
|
value = rxBuffer[rxBufferIndex]; |
||||
|
++rxBufferIndex; |
||||
|
} |
||||
|
|
||||
|
return value; |
||||
|
} |
||||
|
|
||||
|
// must be called after requestFrom(address, numBytes)
|
||||
|
int TwoWire::peek(void) { |
||||
|
int value = -1; |
||||
|
|
||||
|
if(rxBufferIndex < rxBufferLength){ |
||||
|
value = rxBuffer[rxBufferIndex]; |
||||
|
} |
||||
|
|
||||
|
return value; |
||||
|
} |
||||
|
|
||||
|
// Preinstantiate Objects //////////////////////////////////////////////////////
|
||||
|
|
||||
|
TwoWire Wire = TwoWire(); |
||||
|
|
||||
|
#endif // TARGET_LPC1768
|
||||
Loading…
Reference in new issue