From 51a00f59ea9ecb49471b30921f36821fdfa75bc4 Mon Sep 17 00:00:00 2001 From: Daniel Friesel Date: Thu, 14 Dec 2017 15:51:11 +0100 Subject: Add I2C and LM75 drivers --- src/arch/msp430fr5969lp/Makefile.inc | 7 ++- src/arch/msp430fr5969lp/driver/i2c.cc | 92 +++++++++++++++++++++++++++++++++++ src/driver/lm75.cc | 30 ++++++++++++ src/os/object/outputstream.cc | 37 +++++++++++++- 4 files changed, 163 insertions(+), 3 deletions(-) create mode 100644 src/arch/msp430fr5969lp/driver/i2c.cc create mode 100644 src/driver/lm75.cc (limited to 'src') diff --git a/src/arch/msp430fr5969lp/Makefile.inc b/src/arch/msp430fr5969lp/Makefile.inc index 36d19c6..6d2ae6a 100644 --- a/src/arch/msp430fr5969lp/Makefile.inc +++ b/src/arch/msp430fr5969lp/Makefile.inc @@ -10,8 +10,11 @@ CC = /opt/msp430/ti/gcc/bin/msp430-elf-gcc CXX = /opt/msp430/ti/gcc/bin/msp430-elf-g++ OBJCOPY = /opt/msp430/ti/gcc/bin/msp430-elf-objcopy -TARGETS += src/arch/msp430fr5969lp/arch.cc src/arch/msp430fr5969lp/driver/gpio.cc -TARGETS += src/arch/msp430fr5969lp/driver/stdout.cc src/arch/msp430fr5969lp/driver/uptime.cc +TARGETS += src/arch/msp430fr5969lp/arch.cc +TARGETS += src/arch/msp430fr5969lp/driver/gpio.cc +TARGETS += src/arch/msp430fr5969lp/driver/stdout.cc +TARGETS += src/arch/msp430fr5969lp/driver/uptime.cc +TARGETS += src/arch/msp430fr5969lp/driver/i2c.cc OBJECTS = ${TARGETS:.cc=.o} diff --git a/src/arch/msp430fr5969lp/driver/i2c.cc b/src/arch/msp430fr5969lp/driver/i2c.cc new file mode 100644 index 0000000..80f33b0 --- /dev/null +++ b/src/arch/msp430fr5969lp/driver/i2c.cc @@ -0,0 +1,92 @@ +#include "driver/i2c.h" +#include + +signed char I2C::setup() +{ + UCB0CTL1 = UCSWRST; + UCB0CTLW0 = UCMODE_3 | UCMST | UCSYNC | UCSSEL_2 | UCSWRST | UCCLTO_1; + UCB0BRW = 0xf00; + P1DIR &= ~(BIT6 | BIT7); + P1SEL0 &= ~(BIT6 | BIT7); + P1SEL1 |= BIT6 | BIT7; + + UCB0CTL1 &= ~UCSWRST; + UCB0I2CSA = 0; + + __delay_cycles(1600); + + if (UCB0STAT & UCBBUSY) + return -1; + + return 0; +} + +void I2C::scan(unsigned int *results) +{ + for (unsigned char address = 0; address < 128; address++) { + UCB0I2CSA = address; + UCB0CTL1 |= UCTR | UCTXSTT | UCTXSTP; + + while (UCB0CTL1 & UCTXSTP); + + if (UCB0IFG & UCNACKIFG) { + UCB0IFG &= ~UCNACKIFG; + } else { + results[address / (8 * sizeof(unsigned int))] |= 1 << (address % (8 * sizeof(unsigned int))); + } + } + UCB0IFG = 0; +} + +signed char I2C::xmit(unsigned char address, + unsigned char tx_len, unsigned char *tx_buf, + unsigned char rx_len, unsigned char *rx_buf) +{ + unsigned char i; + UCB0I2CSA = address; + if (tx_len) { + UCB0CTL1 |= UCTR | UCTXSTT; + for (i = 0; i < tx_len; i++) { + while (!(UCB0IFG & (UCTXIFG0 | UCNACKIFG | UCCLTOIFG))); + if (UCB0IFG & (UCNACKIFG | UCCLTOIFG)) { + UCB0IFG &= ~UCNACKIFG; + UCB0IFG &= ~UCCLTOIFG; + UCB0CTL1 |= UCTXSTP; + return -1; + } + UCB0TXBUF = tx_buf[i]; + } + while (!(UCB0IFG & (UCTXIFG0 | UCNACKIFG | UCCLTOIFG))); + //if (UCB0IFG & (UCNACKIFG | UCCLTOIFG)) { + // UCB0IFG &= ~UCNACKIFG; + // UCB0IFG &= ~UCCLTOIFG; + // UCB0CTL1 |= UCTXSTP; + // return -1; + //} + } + if (rx_len) { + UCB0I2CSA = address; + UCB0IFG = 0; + UCB0CTL1 &= ~UCTR; + UCB0CTL1 |= UCTXSTT; + + while (UCB0CTL1 & UCTXSTT); + UCB0IFG &= ~UCTXIFG0; + + for (i = 0; i < rx_len; i++) { + if (i == rx_len - 1) + UCB0CTL1 |= UCTXSTP; + while (!(UCB0IFG & (UCRXIFG0 | UCNACKIFG | UCCLTOIFG))); + rx_buf[i] = UCB0RXBUF; + UCB0IFG &= ~UCRXIFG0; + } + UCB0IFG &= ~UCRXIFG0; + } + + UCB0CTL1 |= UCTXSTP; + + while (UCB0CTL1 & UCTXSTP); + return 0; +} + +I2C i2c; diff --git a/src/driver/lm75.cc b/src/driver/lm75.cc new file mode 100644 index 0000000..0bad4a7 --- /dev/null +++ b/src/driver/lm75.cc @@ -0,0 +1,30 @@ +#include "driver/lm75.h" +#include "driver/i2c.h" + +float LM75::getTemp() +{ + txbuf[0] = 0; + rxbuf[0] = 0; + rxbuf[1] = 0; + i2c.xmit(address, 1, txbuf, 2, rxbuf); + + return rxbuf[0] + (rxbuf[1] / 256.0); +} + +void LM75::setOS(unsigned char os) +{ + txbuf[0] = 0x03; + txbuf[1] = os; + txbuf[2] = 0; + i2c.xmit(address, 3, txbuf, 0, rxbuf); +} + +void LM75::setHyst(unsigned char hyst) +{ + txbuf[0] = 0x02; + txbuf[1] = hyst; + txbuf[2] = 0; + i2c.xmit(address, 3, txbuf, 0, rxbuf); +} + +LM75 lm75(0x48); diff --git a/src/os/object/outputstream.cc b/src/os/object/outputstream.cc index f308b56..31b0da4 100644 --- a/src/os/object/outputstream.cc +++ b/src/os/object/outputstream.cc @@ -2,7 +2,7 @@ OutputStream & OutputStream::operator<<(unsigned char c) { - put(c); + *this << (unsigned long long)c; return *this; } @@ -134,6 +134,41 @@ void OutputStream::setBase(uint8_t b) } } +static inline char format_hex_nibble(uint8_t num) +{ + if (num > 9) { + return 'a' + num - 10; + } + return '0' + num; +} + +void OutputStream::printf_uint8(uint8_t num) +{ + put(format_hex_nibble(num / 16)); + put(format_hex_nibble(num % 16)); +} + +void OutputStream::printf_float(float num) +{ + if (num < 0) { + put('-'); + num *= -1; + } + if (num > 1000) { + put('0' + (((int)num % 10000) / 1000)); + } + if (num > 100) { + put('0' + (((int)num % 1000) / 100)); + } + if (num > 10) { + put('0' + (((int)num % 100) / 10)); + } + put('0' + ((int)num % 10)); + put('.'); + put('0' + ((int)(num * 10) % 10)); + put('0' + ((int)(num * 100) % 10)); +} + // FLUSH OutputStream & flush(OutputStream & os) { -- cgit v1.2.3