Skip to content

Instantly share code, notes, and snippets.

@skywodd

skywodd/README.md

Last active January 29, 2019 21:29
Show Gist options
  • Save skywodd/5593766bd7ce8aa8f1fd8be7df5f65ec to your computer and use it in GitHub Desktop.
Save skywodd/5593766bd7ce8aa8f1fd8be7df5f65ec to your computer and use it in GitHub Desktop.
Download ZIP
DigiSpark + Nunchuck controller for Estlcam 11 (using default keyboard shortcuts)
Raw
README.md
Raw
nunchuck.h
/**
* @license Nunchuk Arduino library v0.0.1 16/12/2016
* http://www.xarg.org/2016/12/arduino-nunchuk-library/
*
* Copyright (c) 2016, Robert Eisele ([email protected])
* Dual licensed under the MIT or GPL Version 2 licenses.
**/
#ifndef NUNCHUK_H
#define NUNCHUK_H
// Whether to disable encryption.
#define NUNCHUK_DISABLE_ENCRYPTION
// The Nunchuk I2C address
#define NUNCHUK_ADDRESS 0x52
#if ARDUINO >= 100
#define I2C_READ() TinyWireM.read()
#define I2C_WRITE(x) TinyWireM.write(x)
#else
#define I2C_READ() TinyWireM.receive()
#define I2C_WRITE(x) TinyWireM.send(x)
#endif
#define I2C_START(x) TinyWireM.beginTransmission(x)
#define I2C_STOP() TinyWireM.endTransmission(true)
uint8_t nunchuk_data[6];
/**
* Initializes the Nunchuk communication by sending a sequence of bytes
*/
static void nunchuk_init() {
// Change TWI speed for nuchuk, which uses Fast-TWI (400kHz)
//TinyWireM.setClock(400000);
// delay(1);
#ifdef NUNCHUK_DISABLE_ENCRYPTION
I2C_START(NUNCHUK_ADDRESS);
I2C_WRITE(0xF0);
I2C_WRITE(0x55);
I2C_STOP();
// delay(1);
I2C_START(NUNCHUK_ADDRESS);
I2C_WRITE(0xFB);
I2C_WRITE(0x00);
I2C_STOP();
// delay(1);
#else
I2C_START(NUNCHUK_ADDRESS);
I2C_WRITE(0x40);
I2C_WRITE(0x00);
I2C_STOP();
// delay(1);
#endif
}
/**
* Decodes a byte if encryption is used
*
* @param x The byte to be decoded
*/
static inline uint8_t nunchuk_decode_byte(uint8_t x) {
#ifdef NUNCHUK_DISABLE_ENCRYPTION
return x;
#else
return (x ^ 0x17) + 0x17;
#endif
}
/**
* Central function to read a full chunk of data from Nunchuk
*
* @return A boolean if the data transfer was successful
*/
static uint8_t nunchuk_read() {
uint8_t i;
TinyWireM.requestFrom(NUNCHUK_ADDRESS, 6);
//delayMicroseconds(10);
for (i = 0; i < 6 && TinyWireM.available(); i++) {
nunchuk_data[i] = nunchuk_decode_byte(I2C_READ());
}
I2C_START(NUNCHUK_ADDRESS);
I2C_WRITE(0x00);
// delayMicroseconds(100);
I2C_STOP();
return i == 6;
}
/**
* Checks the current state of button Z
*/
static uint8_t nunchuk_buttonZ() {
return (~nunchuk_data[5] >> 0) & 1;
}
/**
* Checks the current state of button C
*/
static uint8_t nunchuk_buttonC() {
return (~nunchuk_data[5] >> 1) & 1;
}
/**
* Retrieves the raw X-value of the joystick
*/
static uint8_t nunchuk_joystickX() {
return nunchuk_data[0];
}
/**
* Retrieves the raw Y-value of the joystick
*/
static uint8_t nunchuk_joystickY() {
return nunchuk_data[1];
}
#endif
Raw
nuncnchuck.ino
/* USB Keyboard interface */
#include <DigiKeyboard.h>
/* I2C interface */
#define SDA_PORT PORTB
#define SDA_PIN 0
#define SCL_PORT PORTB
#define SCL_PIN 2
#define I2C_FASTMODE 1
#include "SoftWire.h"
SoftWire TinyWireM = SoftWire();
/* Nunchuck interface */
#include "nunchuck.h"
/* USB Keycode */
#define KEYPAD_MINUS 0x56
#define KEYPAD_PLUS 0x57
#define KEYPAD_ONE 0x59
#define KEYPAD_TWO 0x5A
#define KEYPAD_THREE 0x5B
#define KEYPAD_FOUR 0x5C
#define KEYPAD_SIX 0x5E
#define KEYPAD_SEVEN 0x5F
#define KEYPAD_EIGHT 0x60
#define KEYPAD_NINE 0x61
/* Directions */
const byte GO_UP = 1;
const byte GO_DOWN = 2;
const byte GO_RIGHT = 3;
const byte GO_LEFT = 4;
const byte GO_UP_LEFT = 5;
const byte GO_UP_RIGHT = 6;
const byte GO_DOWN_LEFT = 7;
const byte GO_DOWN_RIGHT = 8;
void setup() {
//DigiKeyboard.begin();
TinyWireM.begin();
nunchuk_init();
}
void loop() {
if (nunchuk_read()) {
byte direction = getDirection();
/* If Z and C are pressed */
if (nunchuk_buttonZ() && nunchuk_buttonC()) {
/* Enable keyboard control */
DigiKeyboard.sendKeyStroke(KEY_F2);
/* Wait for release */
while(nunchuk_buttonZ() || nunchuk_buttonC()) {
DigiKeyboard.delay(100);
nunchuk_read();
}
}
/* Control XY or Z */
if (nunchuk_buttonZ()) {
/* Control Z only */
switch(direction) {
case GO_UP:
DigiKeyboard.sendKeyStroke(KEYPAD_PLUS, 0, 0);
break;
case GO_DOWN:
DigiKeyboard.sendKeyStroke(KEYPAD_MINUS, 0, 0);
break;
case GO_RIGHT:
DigiKeyboard.sendKeyStroke(KEYPAD_PLUS, MOD_CONTROL_RIGHT, 0);
break;
case GO_LEFT:
DigiKeyboard.sendKeyStroke(KEYPAD_MINUS, MOD_CONTROL_RIGHT, 0);
break;
default:
DigiKeyboard.sendKeyStroke(0);
break;
}
} else {
byte modifiers = nunchuk_buttonC() ? MOD_CONTROL_RIGHT : 0;
/* Control X and Y */
switch(direction) {
case GO_UP:
DigiKeyboard.sendKeyStroke(KEYPAD_EIGHT, modifiers, 0);
break;
case GO_DOWN:
DigiKeyboard.sendKeyStroke(KEYPAD_TWO, modifiers, 0);
break;
case GO_RIGHT:
DigiKeyboard.sendKeyStroke(KEYPAD_SIX, modifiers, 0);
break;
case GO_LEFT:
DigiKeyboard.sendKeyStroke(KEYPAD_FOUR, modifiers, 0);
break;
case GO_UP_LEFT:
DigiKeyboard.sendKeyStroke(KEYPAD_SEVEN, modifiers, 0);
break;
case GO_UP_RIGHT:
DigiKeyboard.sendKeyStroke(KEYPAD_NINE, modifiers, 0);
break;
case GO_DOWN_LEFT:
DigiKeyboard.sendKeyStroke(KEYPAD_ONE, modifiers, 0);
break;
case GO_DOWN_RIGHT:
DigiKeyboard.sendKeyStroke(KEYPAD_THREE, modifiers, 0);
break;
default:
DigiKeyboard.sendKeyStroke(0);
break;
}
}
}
}
byte getDirection() {
char x, y;
if (nunchuk_joystickX() >= 200)
x = 1;
else if (nunchuk_joystickX() <= 55)
x = -1;
else
x = 0;
if (nunchuk_joystickY() >= 200)
y = 1;
else if (nunchuk_joystickY() <= 55)
y = -1;
else
y = 0;
if (x == 0 && y == 1) return GO_UP;
if (x == 0 && y == -1) return GO_DOWN;
if (x == 1 && y == 0) return GO_RIGHT;
if (x == -1 && y == 0) return GO_LEFT;
if (x == -1 && y == 1) return GO_UP_LEFT;
if (x == 1 && y == 1) return GO_UP_RIGHT;
if (x == -1 && y == -1) return GO_DOWN_LEFT;
if (x == 1 && y == -1) return GO_DOWN_RIGHT;
return 0;
}
Raw
SoftI2CMaster.h
/* Arduino SoftI2C library.
*
* Version 1.4
*
* Copyright (C) 2013, Bernhard Nebel and Peter Fleury
*
* This is a very fast and very light-weight software I2C-master library
* written in assembler. It is based on Peter Fleury's I2C software
* library: http://homepage.hispeed.ch/peterfleury/avr-software.html
* Recently, the hardware implementation has been added to the code,
* which can be enabled by defining I2C_HARDWARE.
*
* This Library is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 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 General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with the Arduino I2cMaster Library. If not, see
* <http://www.gnu.org/licenses/>.
*/
/* In order to use the library, you need to define SDA_PIN, SCL_PIN,
* SDA_PORT and SCL_PORT before including this file. Have a look at
* http://www.arduino.cc/en/Reference/PortManipulation for finding out
* which values to use. For example, if you use digital pin 3 (corresponding
* to PD3) for SDA and digital pin 13 (corresponding to PB5)
* for SCL on a standard Arduino,
* you have to use the following definitions:
* #define SDA_PIN 3
* #define SDA_PORT PORTD
* #define SCL_PIN 5
* #define SCL_PORT PORTB
*
* Alternatively, you can define the compile time constant I2C_HARDWARE,
* in which case the TWI hardware is used. In this case you have to use
* the standard SDA/SCL pins (and, of course, the chip needs to support
* this).
*
* You can also define the following constants (see also below):
' - I2C_PULLUP = 1 meaning that internal pullups should be used
* - I2C_CPUFREQ, when changing CPU clock frequency dynamically
* - I2C_FASTMODE = 1 meaning that the I2C bus allows speeds up to 400 kHz
* - I2C_SLOWMODE = 1 meaning that the I2C bus will allow only up to 25 kHz
* - I2C_NOINTERRUPT = 1 in order to prohibit interrupts while
* communicating (see below). This can be useful if you use the library
* for communicationg with SMbus devices, which have timeouts.
* Note, however, that interrupts are disabled from issuing a start condition
* until issuing a stop condition. So use this option with care!
* - I2C_TIMEOUT = 0..10000 msec in order to return from the I2C functions
* in case of a I2C bus lockup (i.e., SCL constantly low). 0 means no timeout.
* - I2C_MAXWAIT = 0..32767 number of retries in i2c_start_wait. 0 means never stop.
*/
/* Changelog:
* Version 2.1
* - added conditional to check whether it is the right MCU type
* Version 2.0
* - added hardware support as well.
* Version 1.4:
* - added "maximum retry" in i2c_start_wait in order to avoid lockup
* - added "internal pullups", but be careful since the option stretches the I2C specs
* Version 1.3:
* - added "__attribute__ ((used))" for all functions declared with "__attribute__ ((noinline))"
* Now the module is also usable in Arduino 1.6.11+
* Version 1.2:
* - added pragma to avoid "unused parameter warnings" (suggestion by Walter)
* - replaced wrong license file
* Version 1.1:
* - removed I2C_CLOCK_STRETCHING
* - added I2C_TIMEOUT time in msec (0..10000) until timeout or 0 if no timeout
* - changed i2c_init to return true iff both SDA and SCL are high
* - changed interrupt disabling so that the previous IRQ state is restored
* Version 1.0: basic functionality
*/
#ifndef __AVR_ARCH__
#error "Not an AVR MCU! Use 'SlowSoftI2CMaster' library instead of 'SoftI2CMaster'!"
#else
#ifndef _SOFTI2C_H
#define _SOFTI2C_H 1
#include <avr/io.h>
#include <Arduino.h>
#include <util/twi.h>
#pragma GCC diagnostic push
#pragma GCC diagnostic ignored "-Wunused-parameter"
// Init function. Needs to be called once in the beginning.
// Returns false if SDA or SCL are low, which probably means
// a I2C bus lockup or that the lines are not pulled up.
bool __attribute__ ((noinline)) i2c_init(void) __attribute__ ((used));
// Start transfer function: <addr> is the 8-bit I2C address (including the R/W
// bit).
// Return: true if the slave replies with an "acknowledge", false otherwise
bool __attribute__ ((noinline)) i2c_start(uint8_t addr) __attribute__ ((used));
// Similar to start function, but wait for an ACK! Will timeout if I2C_MAXWAIT > 0.
bool __attribute__ ((noinline)) i2c_start_wait(uint8_t addr) __attribute__ ((used));
// Repeated start function: After having claimed the bus with a start condition,
// you can address another or the same chip again without an intervening
// stop condition.
// Return: true if the slave replies with an "acknowledge", false otherwise
bool __attribute__ ((noinline)) i2c_rep_start(uint8_t addr) __attribute__ ((used));
// Issue a stop condition, freeing the bus.
void __attribute__ ((noinline)) i2c_stop(void) asm("ass_i2c_stop") __attribute__ ((used));
// Write one byte to the slave chip that had been addressed
// by the previous start call. <value> is the byte to be sent.
// Return: true if the slave replies with an "acknowledge", false otherwise
bool __attribute__ ((noinline)) i2c_write(uint8_t value) asm("ass_i2c_write") __attribute__ ((used));
// Read one byte. If <last> is true, we send a NAK after having received
// the byte in order to terminate the read sequence.
uint8_t __attribute__ ((noinline)) i2c_read(bool last) __attribute__ ((used));
// If you want to use the TWI hardeware, you have to define I2C_HARDWARE to be 1
#ifndef I2C_HARDWARE
#define I2C_HARDWARE 0
#endif
#if I2C_HARDWARE
#ifndef TWDR
#error This chip does not support hardware I2C. Please undfine I2C_HARDWARE
#endif
#endif
// You can set I2C_CPUFREQ independently of F_CPU if you
// change the CPU frequency on the fly. If you do not define it,
// it will use the value of F_CPU
#ifndef I2C_CPUFREQ
#define I2C_CPUFREQ F_CPU
#endif
// If I2C_FASTMODE is set to 1, then the highest possible frequency below 400kHz
// is selected. Be aware that not all slave chips may be able to deal with that!
#ifndef I2C_FASTMODE
#define I2C_FASTMODE 0
#endif
// If I2C_FASTMODE is not defined or defined to be 0, then you can set
// I2C_SLOWMODE to 1. In this case, the I2C frequency will not be higher
// than 25KHz. This could be useful for problematic buses with high pull-ups
// and high capasitance.
#ifndef I2C_SLOWMODE
#define I2C_SLOWMODE 0
#endif
// If I2C_PULLUP is set to 1, then the internal pull-up resistors are used.
// This does not conform with the I2C specs, since the bus lines will be
// temporarily in high-state and the internal resistors have roughly 50k.
// With low bus speeds und short buses it usually works, though (hopefully).
#ifndef I2C_PULLUP
#define I2C_PULLUP 0
#endif
// if I2C_NOINTERRUPT is 1, then the I2C routines are not interruptable.
// This is most probably only necessary if you are using a 1MHz system clock,
// you are communicating with a SMBus device, and you want to avoid timeouts.
// Be aware that the interrupt bit is enabled after each call. So the
// I2C functions should not be called in interrupt routines or critical regions.
#ifndef I2C_NOINTERRUPT
#define I2C_NOINTERRUPT 0
#endif
// I2C_TIMEOUT can be set to a value between 1 and 10000.
// If it is defined and nonzero, it leads to a timeout if the
// SCL is low longer than I2C_TIMEOUT milliseconds, i.e., max timeout is 10 sec
#ifndef I2C_TIMEOUT
#define I2C_TIMEOUT 0
#else
#if I2C_TIMEOUT > 10000
#error I2C_TIMEOUT is too large
#endif
#endif
// I2C_MAXWAIT can be set to any value between 0 and 32767. 0 means no time out.
#ifndef I2C_MAXWAIT
#define I2C_MAXWAIT 500
#else
#if I2C_MAXWAIT > 32767 || I2C_MAXWAIT < 0
#error Illegal I2C_MAXWAIT value
#endif
#endif
#define I2C_TIMEOUT_DELAY_LOOPS (I2C_CPUFREQ/1000UL)*I2C_TIMEOUT/4000UL
#if I2C_TIMEOUT_DELAY_LOOPS < 1
#define I2C_MAX_STRETCH 1
#else
#if I2C_TIMEOUT_DELAY_LOOPS > 60000UL
#define I2C_MAX_STRETCH 60000UL
#else
#define I2C_MAX_STRETCH I2C_TIMEOUT_DELAY_LOOPS
#endif
#endif
#if I2C_FASTMODE
#define I2C_DELAY_COUNTER (((I2C_CPUFREQ/350000L)/2-18)/3)
#define SCL_CLOCK 400000UL
#else
#if I2C_SLOWMODE
#define I2C_DELAY_COUNTER (((I2C_CPUFREQ/23500L)/2-18)/3)
#define SCL_CLOCK 25000UL
#else
#define I2C_DELAY_COUNTER (((I2C_CPUFREQ/90000L)/2-18)/3)
#define SCL_CLOCK 100000UL
#endif
#endif
// constants for reading & writing
#define I2C_READ 1
#define I2C_WRITE 0
#if !I2C_HARDWARE
// map the IO register back into the IO address space
#define SDA_DDR (_SFR_IO_ADDR(SDA_PORT) - 1)
#define SCL_DDR (_SFR_IO_ADDR(SCL_PORT) - 1)
#define SDA_OUT _SFR_IO_ADDR(SDA_PORT)
#define SCL_OUT _SFR_IO_ADDR(SCL_PORT)
#define SDA_IN (_SFR_IO_ADDR(SDA_PORT) - 2)
#define SCL_IN (_SFR_IO_ADDR(SCL_PORT) - 2)
#ifndef __tmp_reg__
#define __tmp_reg__ 0
#endif
// Internal delay functions.
void __attribute__ ((noinline)) i2c_delay_half(void) asm("ass_i2c_delay_half") __attribute__ ((used));
void __attribute__ ((noinline)) i2c_wait_scl_high(void) asm("ass_i2c_wait_scl_high") __attribute__ ((used));
void i2c_delay_half(void)
{ // function call 3 cycles => 3C
#if I2C_DELAY_COUNTER < 1
__asm__ __volatile__ (" ret");
// 7 cycles for call and return
#else
__asm__ __volatile__
(
" ldi r25, %[DELAY] ;load delay constant ;; 4C \n\t"
"_Lidelay: \n\t"
" dec r25 ;decrement counter ;; 4C+xC \n\t"
" brne _Lidelay ;;5C+(x-1)2C+xC\n\t"
" ret ;; 9C+(x-1)2C+xC = 7C+xC"
: : [DELAY] "M" I2C_DELAY_COUNTER : "r25");
// 7 cycles + 3 times x cycles
#endif
}
void i2c_wait_scl_high(void)
{
#if I2C_TIMEOUT <= 0
__asm__ __volatile__
("_Li2c_wait_stretch: \n\t"
" sbis %[SCLIN],%[SCLPIN] ;wait for SCL high \n\t"
" rjmp _Li2c_wait_stretch \n\t"
" cln ;signal: no timeout \n\t"
" ret "
: : [SCLIN] "I" (SCL_IN), [SCLPIN] "I" (SCL_PIN));
#else
__asm__ __volatile__
( " ldi r27, %[HISTRETCH] ;load delay counter \n\t"
" ldi r26, %[LOSTRETCH] \n\t"
"_Lwait_stretch: \n\t"
" clr __tmp_reg__ ;do next loop 255 times \n\t"
"_Lwait_stretch_inner_loop: \n\t"
" rcall _Lcheck_scl_level ;call check function ;; 12C \n\t"
" brpl _Lstretch_done ;done if N=0 ;; +1 = 13C\n\t"
" dec __tmp_reg__ ;dec inner loop counter;; +1 = 14C\n\t"
" brne _Lwait_stretch_inner_loop ;; +2 = 16C\n\t"
" sbiw r26,1 ;dec outer loop counter \n\t"
" brne _Lwait_stretch ;continue with outer loop \n\t"
" sen ;timeout -> set N-bit=1 \n\t"
" rjmp _Lwait_return ;and return with N=1\n\t"
"_Lstretch_done: ;SCL=1 sensed \n\t"
" cln ;OK -> clear N-bit \n\t"
" rjmp _Lwait_return ; and return with N=0 \n\t"
"_Lcheck_scl_level: ;; call = 3C\n\t"
" cln ;; +1C = 4C \n\t"
" sbic %[SCLIN],%[SCLPIN] ;skip if SCL still low ;; +2C = 6C \n\t"
" rjmp _Lscl_high ;; +0C = 6C \n\t"
" sen ;; +1 = 7C\n\t "
"_Lscl_high: "
" nop ;; +1C = 8C \n\t"
" ret ;return N-Bit=1 if low ;; +4 = 12C\n\t"
"_Lwait_return:"
: : [SCLIN] "I" (SCL_IN), [SCLPIN] "I" (SCL_PIN),
[HISTRETCH] "M" (I2C_MAX_STRETCH>>8),
[LOSTRETCH] "M" (I2C_MAX_STRETCH&0xFF)
: "r26", "r27");
#endif
}
#endif // !I2C_HARDWARE
bool i2c_init(void)
#if I2C_HARDWARE
{
#if I2C_PULLUP
digitalWrite(SDA, 1);
digitalWrite(SCL, 1);
#else
digitalWrite(SDA, 0);
digitalWrite(SCL, 0);
#endif
#if ((I2C_CPUFREQ/SCL_CLOCK)-16)/2 < 250
TWSR = 0; /* no prescaler */
TWBR = ((I2C_CPUFREQ/SCL_CLOCK)-16)/2; /* must be > 10 for stable operation */
#else
TWSR = (1<<TWPS0); // prescaler is 4
TWBR = ((I2C_CPUFREQ/SCL_CLOCK)-16)/8;
#endif
return (digitalRead(SDA) != 0 && digitalRead(SCL) != 0);
}
#else
{
__asm__ __volatile__
(" cbi %[SDADDR],%[SDAPIN] ;release SDA \n\t"
" cbi %[SCLDDR],%[SCLPIN] ;release SCL \n\t"
#if I2C_PULLUP
" sbi %[SDAOUT],%[SDAPIN] ;enable SDA pull-up\n\t"
#else
" cbi %[SDAOUT],%[SDAPIN] ;clear SDA output value \n\t"
#endif
#if I2C_PULLUP
" sbi %[SCLOUT],%[SCLPIN] ;enable SCL pull-up\n\t"
#else
" cbi %[SCLOUT],%[SCLPIN] ;clear SCL output value \n\t"
#endif
" clr r24 ;set return value to false \n\t"
" clr r25 ;set return value to false \n\t"
" sbis %[SDAIN],%[SDAPIN] ;check for SDA high\n\t"
" ret ;if low return with false \n\t"
" sbis %[SCLIN],%[SCLPIN] ;check for SCL high \n\t"
" ret ;if low return with false \n\t"
" ldi r24,1 ;set return value to true \n\t"
" ret "
: :
[SCLDDR] "I" (SCL_DDR), [SCLPIN] "I" (SCL_PIN),
[SCLIN] "I" (SCL_IN), [SCLOUT] "I" (SCL_OUT),
[SDADDR] "I" (SDA_DDR), [SDAPIN] "I" (SDA_PIN),
[SDAIN] "I" (SDA_IN), [SDAOUT] "I" (SDA_OUT));
return true;
}
#endif
bool i2c_start(uint8_t addr)
#if I2C_HARDWARE
{
uint8_t twst;
#if I2C_TIMEOUT
uint32_t start = millis();
#endif
// send START condition
TWCR = (1<<TWINT) | (1<<TWSTA) | (1<<TWEN);
// wait until transmission completed
while(!(TWCR & (1<<TWINT))) {
#if I2C_TIMEOUT
if (millis() - start > I2C_TIMEOUT) return false;
#endif
}
// check value of TWI Status Register. Mask prescaler bits.
twst = TW_STATUS & 0xF8;
if ( (twst != TW_START) && (twst != TW_REP_START)) return false;
// send device address
TWDR = addr;
TWCR = (1<<TWINT) | (1<<TWEN);
// wail until transmission completed and ACK/NACK has been received
while(!(TWCR & (1<<TWINT))) {
#if I2C_TIMEOUT
if (millis() - start > I2C_TIMEOUT) return false;
#endif
}
// check value of TWI Status Register. Mask prescaler bits.
twst = TW_STATUS & 0xF8;
if ( (twst != TW_MT_SLA_ACK) && (twst != TW_MR_SLA_ACK) ) return false;
return true;
}
#else
{
__asm__ __volatile__
(
#if I2C_NOINTERRUPT
" cli ;clear IRQ bit \n\t"
#endif
" sbis %[SCLIN],%[SCLPIN] ;check for clock stretching slave\n\t"
" rcall ass_i2c_wait_scl_high ;wait until SCL=H\n\t"
#if I2C_PULLUP
" cbi %[SDAOUT],%[SDAPIN] ;disable pull-up \n\t"
#endif
" sbi %[SDADDR],%[SDAPIN] ;force SDA low \n\t"
" rcall ass_i2c_delay_half ;wait T/2 \n\t"
" rcall ass_i2c_write ;now write address \n\t"
" ret"
: : [SDADDR] "I" (SDA_DDR), [SDAPIN] "I" (SDA_PIN),
[SDAOUT] "I" (SDA_OUT), [SCLOUT] "I" (SCL_OUT),
[SCLIN] "I" (SCL_IN),[SCLPIN] "I" (SCL_PIN));
return true; // we never return here!
}
#endif
bool i2c_rep_start(uint8_t addr)
#if I2C_HARDWARE
{
return i2c_start(addr);
}
#else
{
__asm__ __volatile__
(
#if I2C_NOINTERRUPT
" cli \n\t"
#endif
#if I2C_PULLUP
" cbi %[SCLOUT],%[SCLPIN] ;disable SCL pull-up \n\t"
#endif
" sbi %[SCLDDR],%[SCLPIN] ;force SCL low \n\t"
" rcall ass_i2c_delay_half ;delay T/2 \n\t"
" cbi %[SDADDR],%[SDAPIN] ;release SDA \n\t"
#if I2C_PULLUP
" sbi %[SDAOUT],%[SDAPIN] ;enable SDA pull-up \n\t"
#endif
" rcall ass_i2c_delay_half ;delay T/2 \n\t"
" cbi %[SCLDDR],%[SCLPIN] ;release SCL \n\t"
#if I2C_PULLUP
" sbi %[SCLOUT],%[SCLPIN] ;enable SCL pull-up \n\t"
#endif
" rcall ass_i2c_delay_half ;delay T/2 \n\t"
" sbis %[SCLIN],%[SCLPIN] ;check for clock stretching slave\n\t"
" rcall ass_i2c_wait_scl_high ;wait until SCL=H\n\t"
#if I2C_PULLUP
" cbi %[SDAOUT],%[SDAPIN] ;disable SDA pull-up\n\t"
#endif
" sbi %[SDADDR],%[SDAPIN] ;force SDA low \n\t"
" rcall ass_i2c_delay_half ;delay T/2 \n\t"
" rcall ass_i2c_write \n\t"
" ret"
: : [SCLDDR] "I" (SCL_DDR), [SCLPIN] "I" (SCL_PIN),
[SCLIN] "I" (SCL_IN), [SCLOUT] "I" (SCL_OUT), [SDAOUT] "I" (SDA_OUT),
[SDADDR] "I" (SDA_DDR), [SDAPIN] "I" (SDA_PIN));
return true; // just to fool the compiler
}
#endif
bool i2c_start_wait(uint8_t addr)
#if I2C_HARDWARE
{
uint8_t twst;
uint16_t maxwait = I2C_MAXWAIT;
#if I2C_TIMEOUT
uint32_t start = millis();
#endif
while (true) {
// send START condition
TWCR = (1<<TWINT) | (1<<TWSTA) | (1<<TWEN);
// wait until transmission completed
while(!(TWCR & (1<<TWINT))) {
#if I2C_TIMEOUT
if (millis() - start > I2C_TIMEOUT) return false;
#endif
}
// check value of TWI Status Register. Mask prescaler bits.
twst = TW_STATUS & 0xF8;
if ( (twst != TW_START) && (twst != TW_REP_START)) continue;
// send device address
TWDR = addr;
TWCR = (1<<TWINT) | (1<<TWEN);
// wail until transmission completed
while(!(TWCR & (1<<TWINT))) {
#if I2C_TIMEOUT
if (millis() - start > I2C_TIMEOUT) return false;
#endif
}
// check value of TWI Status Register. Mask prescaler bits.
twst = TW_STATUS & 0xF8;
if ( (twst == TW_MT_SLA_NACK )||(twst ==TW_MR_DATA_NACK) )
{
/* device busy, send stop condition to terminate write operation */
TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWSTO);
// wait until stop condition is executed and bus released
while(TWCR & (1<<TWSTO)) {
#if I2C_TIMEOUT
if (millis() - start > I2C_TIMEOUT) return false;
#endif
}
if (maxwait)
if (--maxwait == 0)
return false;
continue;
}
//if( twst != TW_MT_SLA_ACK) return 1;
return true;
}
}
#else
{
__asm__ __volatile__
(
" push r24 ;save original parameter \n\t"
#if I2C_MAXWAIT
" ldi r31, %[HIMAXWAIT] ;load max wait counter \n\t"
" ldi r30, %[LOMAXWAIT] ;load low byte \n\t"
#endif
"_Li2c_start_wait1: \n\t"
" pop r24 ;restore original parameter\n\t"
" push r24 ;and save again \n\t"
#if I2C_NOINTERRUPT
" cli ;disable interrupts \n\t"
#endif
" sbis %[SCLIN],%[SCLPIN] ;check for clock stretching slave\n\t"
" rcall ass_i2c_wait_scl_high ;wait until SCL=H\n\t"
#if I2C_PULLUP
" cbi %[SDAOUT],%[SDAPIN] ;disable pull-up \n\t"
#endif
" sbi %[SDADDR],%[SDAPIN] ;force SDA low \n\t"
" rcall ass_i2c_delay_half ;delay T/2 \n\t"
" rcall ass_i2c_write ;write address \n\t"
" tst r24 ;if device not busy -> done \n\t"
" brne _Li2c_start_wait_done \n\t"
" rcall ass_i2c_stop ;terminate write & enable IRQ \n\t"
#if I2C_MAXWAIT
" sbiw r30,1 ;decrement max wait counter\n\t"
" breq _Li2c_start_wait_done ;if zero reached, exit with false -> r24 already zero!\n\t"
#endif
" rjmp _Li2c_start_wait1 ;device busy, poll ack again \n\t"
"_Li2c_start_wait_done: \n\t"
" clr r25 ;clear high byte of return value\n\t"
" pop __tmp_reg__ ;pop off orig argument \n\t"
" ret "
: : [SDADDR] "I" (SDA_DDR), [SDAPIN] "I" (SDA_PIN), [SDAOUT] "I" (SDA_OUT),
[SCLIN] "I" (SCL_IN), [SCLPIN] "I" (SCL_PIN),
[HIMAXWAIT] "M" (I2C_MAXWAIT>>8),
[LOMAXWAIT] "M" (I2C_MAXWAIT&0xFF)
: "r30", "r31" );
}
#endif
void i2c_stop(void)
#if I2C_HARDWARE
{
#if I2C_TIMEOUT
uint32_t start = millis();
#endif
/* send stop condition */
TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWSTO);
// wait until stop condition is executed and bus released
while(TWCR & (1<<TWSTO)) {
#if I2C_TIMEOUT
if (millis() - start > I2C_TIMEOUT) return;
#endif
}
}
#else
{
__asm__ __volatile__
(
#if I2C_PULLUP
" cbi %[SCLOUT],%[SCLPIN] ;disable SCL pull-up \n\t"
#endif
" sbi %[SCLDDR],%[SCLPIN] ;force SCL low \n\t"
#if I2C_PULLUP
" cbi %[SDAOUT],%[SDAPIN] ;disable pull-up \n\t"
#endif
" sbi %[SDADDR],%[SDAPIN] ;force SDA low \n\t"
" rcall ass_i2c_delay_half ;T/2 delay \n\t"
" cbi %[SCLDDR],%[SCLPIN] ;release SCL \n\t"
#if I2C_PULLUP
" sbi %[SCLOUT],%[SCLPIN] ;enable SCL pull-up \n\t"
#endif
" rcall ass_i2c_delay_half ;T/2 delay \n\t"
" sbis %[SCLIN],%[SCLPIN] ;check for clock stretching slave\n\t"
" rcall ass_i2c_wait_scl_high ;wait until SCL=H\n\t"
" cbi %[SDADDR],%[SDAPIN] ;release SDA \n\t"
#if I2C_PULLUP
" sbi %[SDAOUT],%[SDAPIN] ;enable SDA pull-up \n\t"
#endif
" rcall ass_i2c_delay_half \n\t"
#if I2C_NOINTERRUPT
" sei ;enable interrupts again!\n\t"
#endif
: : [SCLDDR] "I" (SCL_DDR), [SCLPIN] "I" (SCL_PIN), [SCLIN] "I" (SCL_IN),
[SDAOUT] "I" (SDA_OUT), [SCLOUT] "I" (SCL_OUT),
[SDADDR] "I" (SDA_DDR), [SDAPIN] "I" (SDA_PIN));
}
#endif
bool i2c_write(uint8_t value)
#if I2C_HARDWARE
{
uint8_t twst;
#if I2C_TIMEOUT
uint32_t start = millis();
#endif
// send data to the previously addressed device
TWDR = value;
TWCR = (1<<TWINT) | (1<<TWEN);
// wait until transmission completed
while(!(TWCR & (1<<TWINT))) {
#if I2C_TIMEOUT
if (millis() - start > I2C_TIMEOUT) return false;
#endif
}
// check value of TWI Status Register. Mask prescaler bits
twst = TW_STATUS & 0xF8;
if( twst != TW_MT_DATA_ACK) return false;
return true;
}
#else
{
__asm__ __volatile__
(
" sec ;set carry flag \n\t"
" rol r24 ;shift in carry and shift out MSB \n\t"
" rjmp _Li2c_write_first \n\t"
"_Li2c_write_bit:\n\t"
" lsl r24 ;left shift into carry ;; 1C\n\t"
"_Li2c_write_first:\n\t"
" breq _Li2c_get_ack ;jump if TXreg is empty;; +1 = 2C \n\t"
#if I2C_PULLUP
" cbi %[SCLOUT],%[SCLPIN] ;disable SCL pull-up \n\t"
#endif
" sbi %[SCLDDR],%[SCLPIN] ;force SCL low ;; +2 = 4C \n\t"
" nop \n\t"
" nop \n\t"
" nop \n\t"
" brcc _Li2c_write_low ;;+1/+2=5/6C\n\t"
" nop ;; +1 = 7C \n\t"
" cbi %[SDADDR],%[SDAPIN] ;release SDA ;; +2 = 9C \n\t"
#if I2C_PULLUP
" sbi %[SDAOUT],%[SDAPIN] ;enable SDA pull-up \n\t"
#endif
" rjmp _Li2c_write_high ;; +2 = 11C \n\t"
"_Li2c_write_low: \n\t"
#if I2C_PULLUP
" cbi %[SDAOUT],%[SDAPIN] ;disable pull-up \n\t"
#endif
" sbi %[SDADDR],%[SDAPIN] ;force SDA low ;; +2 = 9C \n\t"
" rjmp _Li2c_write_high ;;+2 = 11C \n\t"
"_Li2c_write_high: \n\t"
#if I2C_DELAY_COUNTER >= 1
" rcall ass_i2c_delay_half ;delay T/2 ;;+X = 11C+X\n\t"
#endif
" cbi %[SCLDDR],%[SCLPIN] ;release SCL ;;+2 = 13C+X\n\t"
#if I2C_PULLUP
" sbi %[SCLOUT],%[SCLPIN] ;enable SCL pull-up \n\t"
#endif
" cln ;clear N-bit ;;+1 = 14C+X\n\t"
" nop \n\t"
" nop \n\t"
" nop \n\t"
" sbis %[SCLIN],%[SCLPIN] ;check for SCL high ;;+2 = 16C+X\n\t"
" rcall ass_i2c_wait_scl_high \n\t"
" brpl _Ldelay_scl_high ;;+2 = 18C+X\n\t"
"_Li2c_write_return_false: \n\t"
" clr r24 ; return false because of timeout \n\t"
" rjmp _Li2c_write_return \n\t"
"_Ldelay_scl_high: \n\t"
#if I2C_DELAY_COUNTER >= 1
" rcall ass_i2c_delay_half ;delay T/2 ;;+X= 18C+2X\n\t"
#endif
" rjmp _Li2c_write_bit \n\t"
" ;; +2 = 20C +2X for one bit-loop \n\t"
"_Li2c_get_ack: \n\t"
#if I2C_PULLUP
" cbi %[SCLOUT],%[SCLPIN] ;disable SCL pull-up \n\t"
#endif
" sbi %[SCLDDR],%[SCLPIN] ;force SCL low ;; +2 = 5C \n\t"
" nop \n\t"
" nop \n\t"
" cbi %[SDADDR],%[SDAPIN] ;release SDA ;;+2 = 7C \n\t"
#if I2C_PULLUP
" sbi %[SDAOUT],%[SDAPIN] ;enable SDA pull-up \n\t"
#endif
#if I2C_DELAY_COUNTER >= 1
" rcall ass_i2c_delay_half ;delay T/2 ;; +X = 7C+X \n\t"
#endif
" clr r25 ;; 17C+2X \n\t"
" clr r24 ;return 0 ;; 14C + X \n\t"
" cbi %[SCLDDR],%[SCLPIN] ;release SCL ;; +2 = 9C+X\n\t"
#if I2C_PULLUP
" sbi %[SCLOUT],%[SCLPIN] ;enable SCL pull-up \n\t"
#endif
"_Li2c_ack_wait: \n\t"
" cln ; clear N-bit ;; 10C + X\n\t"
" nop \n\t"
" sbis %[SCLIN],%[SCLPIN] ;wait SCL high ;; 12C + X \n\t"
" rcall ass_i2c_wait_scl_high \n\t"
" brmi _Li2c_write_return_false ;; 13C + X \n\t "
" sbis %[SDAIN],%[SDAPIN] ;if SDA hi -> return 0 ;; 15C + X \n\t"
" ldi r24,1 ;return true ;; 16C + X \n\t"
#if I2C_DELAY_COUNTER >= 1
" rcall ass_i2c_delay_half ;delay T/2 ;; 16C + 2X \n\t"
#endif
"_Li2c_write_return: \n\t"
" nop \n\t "
" nop \n\t "
#if I2C_PULLUP
" cbi %[SCLOUT],%[SCLPIN] ;disable SCL pull-up \n\t"
#endif
" sbi %[SCLDDR],%[SCLPIN] ;force SCL low so SCL=H is short\n\t"
" ret \n\t"
" ;; + 4 = 17C + 2X for acknowldge bit"
::
[SCLDDR] "I" (SCL_DDR), [SCLPIN] "I" (SCL_PIN), [SCLIN] "I" (SCL_IN),
[SDAOUT] "I" (SDA_OUT), [SCLOUT] "I" (SCL_OUT),
[SDADDR] "I" (SDA_DDR), [SDAPIN] "I" (SDA_PIN), [SDAIN] "I" (SDA_IN));
return true; // fooling the compiler
}
#endif
uint8_t i2c_read(bool last)
#if I2C_HARDWARE
{
#if I2C_TIMEOUT
uint32_t start = millis();
#endif
TWCR = (1<<TWINT) | (1<<TWEN) | (last ? 0 : (1<<TWEA));
while(!(TWCR & (1<<TWINT))) {
#if I2C_TIMEOUT
if (millis() - start > I2C_TIMEOUT) return 0xFF;
#endif
}
return TWDR;
}
#else
{
__asm__ __volatile__
(
" ldi r23,0x01 \n\t"
"_Li2c_read_bit: \n\t"
#if I2C_PULLUP
" cbi %[SCLOUT],%[SCLPIN] ;disable SCL pull-up \n\t"
#endif
" sbi %[SCLDDR],%[SCLPIN] ;force SCL low ;; 2C \n\t"
" cbi %[SDADDR],%[SDAPIN] ;release SDA(prev. ACK);; 4C \n\t"
#if I2C_PULLUP
" sbi %[SDAOUT],%[SDAPIN] ;enable SDA pull-up \n\t"
#endif
" nop \n\t"
" nop \n\t"
" nop \n\t"
#if I2C_DELAY_COUNTER >= 1
" rcall ass_i2c_delay_half ;delay T/2 ;; 4C+X \n\t"
#endif
" cbi %[SCLDDR],%[SCLPIN] ;release SCL ;; 6C + X \n\t"
#if I2C_PULLUP
" sbi %[SCLOUT],%[SCLPIN] ;enable SCL pull-up \n\t"
#endif
#if I2C_DELAY_COUNTER >= 1
" rcall ass_i2c_delay_half ;delay T/2 ;; 6C + 2X \n\t"
#endif
" cln ; clear N-bit ;; 7C + 2X \n\t"
" nop \n\t "
" nop \n\t "
" nop \n\t "
" sbis %[SCLIN], %[SCLPIN] ;check for SCL high ;; 9C +2X \n\t"
" rcall ass_i2c_wait_scl_high \n\t"
" brmi _Li2c_read_return ;return if timeout ;; 10C + 2X\n\t"
" clc ;clear carry flag ;; 11C + 2X\n\t"
" sbic %[SDAIN],%[SDAPIN] ;if SDA is high ;; 11C + 2X\n\t"
" sec ;set carry flag ;; 12C + 2X\n\t"
" rol r23 ;store bit ;; 13C + 2X\n\t"
" brcc _Li2c_read_bit ;while receiv reg not full \n\t"
" ;; 15C + 2X for one bit loop \n\t"
"_Li2c_put_ack: \n\t"
#if I2C_PULLUP
" cbi %[SCLOUT],%[SCLPIN] ;disable SCL pull-up \n\t"
#endif
" sbi %[SCLDDR],%[SCLPIN] ;force SCL low ;; 2C \n\t"
" cpi r24,0 ;; 3C \n\t"
" breq _Li2c_put_ack_low ;if (ack=0) ;; 5C \n\t"
" cbi %[SDADDR],%[SDAPIN] ;release SDA \n\t"
#if I2C_PULLUP
" sbi %[SDAOUT],%[SDAPIN] ;enable SDA pull-up \n\t"
#endif
" rjmp _Li2c_put_ack_high \n\t"
"_Li2c_put_ack_low: ;else \n\t"
#if I2C_PULLUP
" cbi %[SDAOUT],%[SDAPIN] ;disable pull-up \n\t"
#endif
" sbi %[SDADDR],%[SDAPIN] ;force SDA low ;; 7C \n\t"
"_Li2c_put_ack_high: \n\t"
" nop \n\t "
" nop \n\t "
" nop \n\t "
#if I2C_DELAY_COUNTER >= 1
" rcall ass_i2c_delay_half ;delay T/2 ;; 7C + X \n\t"
#endif
" cbi %[SCLDDR],%[SCLPIN] ;release SCL ;; 9C +X \n\t"
#if I2C_PULLUP
" sbi %[SCLOUT],%[SCLPIN] ;enable SCL pull-up \n\t"
#endif
" cln ;clear N ;; +1 = 10C\n\t"
" nop \n\t "
" nop \n\t "
" sbis %[SCLIN],%[SCLPIN] ;wait SCL high ;; 12C + X\n\t"
" rcall ass_i2c_wait_scl_high \n\t"
#if I2C_DELAY_COUNTER >= 1
" rcall ass_i2c_delay_half ;delay T/2 ;; 11C + 2X\n\t"
#endif
"_Li2c_read_return: \n\t"
" nop \n\t "
" nop \n\t "
#if I2C_PULLUP
" cbi %[SCLOUT],%[SCLPIN] ;disable SCL pull-up \n\t"
#endif
"sbi %[SCLDDR],%[SCLPIN] ;force SCL low so SCL=H is short\n\t"
" mov r24,r23 ;; 12C + 2X \n\t"
" clr r25 ;; 13 C + 2X\n\t"
" ret ;; 17C + X"
::
[SCLDDR] "I" (SCL_DDR), [SCLPIN] "I" (SCL_PIN), [SCLIN] "I" (SCL_IN),
[SDAOUT] "I" (SDA_OUT), [SCLOUT] "I" (SCL_OUT),
[SDADDR] "I" (SDA_DDR), [SDAPIN] "I" (SDA_PIN), [SDAIN] "I" (SDA_IN)
);
return ' '; // fool the compiler!
}
#endif
#pragma GCC diagnostic pop
#endif
#endif
Raw
SoftWire.h
/*
SoftWire.h - A Wire compatible wrapper for SoftI2CMaster
Copyright (c) 2016 Bernhard Nebel.
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
*/
#ifndef _SoftWire_h
#define _SoftWire_h
#include "SoftI2CMaster.h"
#include <inttypes.h>
#include "Stream.h"
#define BUFFER_LENGTH 32
// WIRE_HAS_END means Wire has end()
#define WIRE_HAS_END 1
class SoftWire : public Stream
{
private:
uint8_t rxBuffer[BUFFER_LENGTH];
uint8_t rxBufferIndex;
uint8_t rxBufferLength;
uint8_t transmitting;
uint8_t error;
public:
SoftWire(void) {
}
void begin(void) {
rxBufferIndex = 0;
rxBufferLength = 0;
error = 0;
transmitting = false;
i2c_init();
}
void end(void) {
}
void setClock(uint32_t _) {
}
void beginTransmission(uint8_t address) {
if (transmitting) {
error = (i2c_rep_start((address<<1)|I2C_WRITE) ? 0 : 2);
} else {
error = (i2c_start((address<<1)|I2C_WRITE) ? 0 : 2);
}
// indicate that we are transmitting
transmitting = 1;
}
void beginTransmission(int address) {
beginTransmission((uint8_t)address);
}
uint8_t endTransmission(uint8_t sendStop)
{
uint8_t transError = error;
if (sendStop) {
i2c_stop();
transmitting = 0;
}
error = 0;
return transError;
}
// This provides backwards compatibility with the original
// definition, and expected behaviour, of endTransmission
//
uint8_t endTransmission(void)
{
return endTransmission(true);
}
size_t write(uint8_t data) {
if (i2c_write(data)) {
return 1;
} else {
if (error == 0) error = 3;
return 0;
}
}
void write(const uint8_t *data, size_t quantity) {
size_t trans = 0;
for(size_t i = 0; i < quantity; ++i){
trans += write(data[i]);
}
//return trans;
}
uint8_t requestFrom(uint8_t address, uint8_t quantity,
uint32_t iaddress, uint8_t isize, uint8_t sendStop) {
uint8_t localerror = 0;
if (isize > 0) {
// send internal address; this mode allows sending a repeated start to access
// some devices' internal registers. This function is executed by the hardware
// TWI module on other processors (for example Due's TWI_IADR and TWI_MMR registers)
beginTransmission(address);
// the maximum size of internal address is 3 bytes
if (isize > 3){
isize = 3;
}
// write internal register address - most significant byte first
while (isize-- > 0)
write((uint8_t)(iaddress >> (isize*8)));
endTransmission(false);
}
// clamp to buffer length
if(quantity > BUFFER_LENGTH){
quantity = BUFFER_LENGTH;
}
localerror = !i2c_rep_start((address<<1) | I2C_READ);
if (error == 0 && localerror) error = 2;
// perform blocking read into buffer
for (uint8_t cnt=0; cnt < quantity; cnt++)
rxBuffer[cnt] = i2c_read(cnt == quantity-1);
// set rx buffer iterator vars
rxBufferIndex = 0;
rxBufferLength = quantity;
if (sendStop) {
transmitting = 0;
i2c_stop();
}
return quantity;
}
uint8_t requestFrom(uint8_t address, uint8_t quantity, uint8_t sendStop) {
return requestFrom((uint8_t)address, (uint8_t)quantity, (uint32_t)0, (uint8_t)0, (uint8_t)sendStop);
}
uint8_t requestFrom(int address, int quantity, int sendStop) {
return requestFrom((uint8_t)address, (uint8_t)quantity, (uint8_t)sendStop);
}
uint8_t requestFrom(uint8_t address, uint8_t quantity) {
return requestFrom((uint8_t)address, (uint8_t)quantity, (uint8_t)true);
}
uint8_t requestFrom(int address, int quantity) {
return requestFrom((uint8_t)address, (uint8_t)quantity, (uint8_t)true);
}
int available(void) {
return rxBufferLength - rxBufferIndex;
}
int read(void) {
int value = -1;
if(rxBufferIndex < rxBufferLength){
value = rxBuffer[rxBufferIndex];
++rxBufferIndex;
}
return value;
}
int peek(void) {
int value = -1;
if(rxBufferIndex < rxBufferLength){
value = rxBuffer[rxBufferIndex];
}
return value;
}
void flush(void) {
}
inline size_t write(unsigned long n) { return write((uint8_t)n); }
inline size_t write(long n) { return write((uint8_t)n); }
inline size_t write(unsigned int n) { return write((uint8_t)n); }
inline size_t write(int n) { return write((uint8_t)n); }
using Print::write;
};
#endif
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment