diff options
| author | HampusM <hampus@hampusmat.com> | 2022-03-07 13:48:57 +0100 | 
|---|---|---|
| committer | HampusM <hampus@hampusmat.com> | 2022-03-07 13:48:57 +0100 | 
| commit | 563f69b870a7f71026c50605b531ed40d667b0a2 (patch) | |
| tree | f9dd8374cae6affb3b52d79e22823c78187b99ed /cores/xinput | |
| parent | f4a2dc0440d17e4c9e609e01e12fcd786d268cf7 (diff) | |
Diffstat (limited to 'cores/xinput')
49 files changed, 8421 insertions, 0 deletions
| diff --git a/cores/xinput/Arduino.h b/cores/xinput/Arduino.h new file mode 100644 index 0000000..91eeb16 --- /dev/null +++ b/cores/xinput/Arduino.h @@ -0,0 +1,260 @@ +/* +  Arduino.h - Main include file for the Arduino SDK +  Copyright (c) 2005-2013 Arduino Team.  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 +*/ + +#ifndef Arduino_h +#define Arduino_h + +#include <stdlib.h> +#include <stdbool.h> +#include <string.h> +#include <math.h> + +#include <avr/pgmspace.h> +#include <avr/io.h> +#include <avr/interrupt.h> + +#include "binary.h" + +#ifdef __cplusplus +extern "C"{ +#endif + +void yield(void); + +#define HIGH 0x1 +#define LOW  0x0 + +#define INPUT 0x0 +#define OUTPUT 0x1 +#define INPUT_PULLUP 0x2 + +#define PI 3.1415926535897932384626433832795 +#define HALF_PI 1.5707963267948966192313216916398 +#define TWO_PI 6.283185307179586476925286766559 +#define DEG_TO_RAD 0.017453292519943295769236907684886 +#define RAD_TO_DEG 57.295779513082320876798154814105 +#define EULER 2.718281828459045235360287471352 + +#define SERIAL  0x0 +#define DISPLAY 0x1 + +#define LSBFIRST 0 +#define MSBFIRST 1 + +#define CHANGE 1 +#define FALLING 2 +#define RISING 3 + +#if defined(__AVR_ATtiny24__) || defined(__AVR_ATtiny44__) || defined(__AVR_ATtiny84__) +  #define DEFAULT 0 +  #define EXTERNAL 1 +  #define INTERNAL1V1 2 +  #define INTERNAL INTERNAL1V1 +#elif defined(__AVR_ATtiny25__) || defined(__AVR_ATtiny45__) || defined(__AVR_ATtiny85__) +  #define DEFAULT 0 +  #define EXTERNAL 4 +  #define INTERNAL1V1 8 +  #define INTERNAL INTERNAL1V1 +  #define INTERNAL2V56 9 +  #define INTERNAL2V56_EXTCAP 13 +#else   +#if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__) || defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__) || defined(__AVR_ATmega644__) || defined(__AVR_ATmega644A__) || defined(__AVR_ATmega644P__) || defined(__AVR_ATmega644PA__) +#define INTERNAL1V1 2 +#define INTERNAL2V56 3 +#else +#define INTERNAL 3 +#endif +#define DEFAULT 1 +#define EXTERNAL 0 +#endif + +// undefine stdlib's abs if encountered +#ifdef abs +#undef abs +#endif + +#define min(a,b) ((a)<(b)?(a):(b)) +#define max(a,b) ((a)>(b)?(a):(b)) +#define abs(x) ((x)>0?(x):-(x)) +#define constrain(amt,low,high) ((amt)<(low)?(low):((amt)>(high)?(high):(amt))) +#define round(x)     ((x)>=0?(long)((x)+0.5):(long)((x)-0.5)) +#define radians(deg) ((deg)*DEG_TO_RAD) +#define degrees(rad) ((rad)*RAD_TO_DEG) +#define sq(x) ((x)*(x)) + +#define interrupts() sei() +#define noInterrupts() cli() + +#define clockCyclesPerMicrosecond() ( F_CPU / 1000000L ) +#define clockCyclesToMicroseconds(a) ( (a) / clockCyclesPerMicrosecond() ) +#define microsecondsToClockCycles(a) ( (a) * clockCyclesPerMicrosecond() ) + +#define lowByte(w) ((uint8_t) ((w) & 0xff)) +#define highByte(w) ((uint8_t) ((w) >> 8)) + +#define bitRead(value, bit) (((value) >> (bit)) & 0x01) +#define bitSet(value, bit) ((value) |= (1UL << (bit))) +#define bitClear(value, bit) ((value) &= ~(1UL << (bit))) +#define bitToggle(value, bit) ((value) ^= (1UL << (bit))) +#define bitWrite(value, bit, bitvalue) ((bitvalue) ? bitSet(value, bit) : bitClear(value, bit)) + +// avr-libc defines _NOP() since 1.6.2 +#ifndef _NOP +#define _NOP() do { __asm__ volatile ("nop"); } while (0) +#endif + +typedef unsigned int word; + +#define bit(b) (1UL << (b)) + +typedef bool boolean; +typedef uint8_t byte; + +void init(void); +void initVariant(void); + +int atexit(void (*func)()) __attribute__((weak)); + +void pinMode(uint8_t pin, uint8_t mode); +void digitalWrite(uint8_t pin, uint8_t val); +int digitalRead(uint8_t pin); +int analogRead(uint8_t pin); +void analogReference(uint8_t mode); +void analogWrite(uint8_t pin, int val); + +unsigned long millis(void); +unsigned long micros(void); +void delay(unsigned long ms); +void delayMicroseconds(unsigned int us); +unsigned long pulseIn(uint8_t pin, uint8_t state, unsigned long timeout); +unsigned long pulseInLong(uint8_t pin, uint8_t state, unsigned long timeout); + +void shiftOut(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder, uint8_t val); +uint8_t shiftIn(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder); + +void attachInterrupt(uint8_t interruptNum, void (*userFunc)(void), int mode); +void detachInterrupt(uint8_t interruptNum); + +void setup(void); +void loop(void); + +// Get the bit location within the hardware port of the given virtual pin. +// This comes from the pins_*.c file for the active board configuration. + +#define analogInPinToBit(P) (P) + +// On the ATmega1280, the addresses of some of the port registers are +// greater than 255, so we can't store them in uint8_t's. +extern const uint16_t PROGMEM port_to_mode_PGM[]; +extern const uint16_t PROGMEM port_to_input_PGM[]; +extern const uint16_t PROGMEM port_to_output_PGM[]; + +extern const uint8_t PROGMEM digital_pin_to_port_PGM[]; +// extern const uint8_t PROGMEM digital_pin_to_bit_PGM[]; +extern const uint8_t PROGMEM digital_pin_to_bit_mask_PGM[]; +extern const uint8_t PROGMEM digital_pin_to_timer_PGM[]; + +// Get the bit location within the hardware port of the given virtual pin. +// This comes from the pins_*.c file for the active board configuration. +//  +// These perform slightly better as macros compared to inline functions +// +#define digitalPinToPort(P) ( pgm_read_byte( digital_pin_to_port_PGM + (P) ) ) +#define digitalPinToBitMask(P) ( pgm_read_byte( digital_pin_to_bit_mask_PGM + (P) ) ) +#define digitalPinToTimer(P) ( pgm_read_byte( digital_pin_to_timer_PGM + (P) ) ) +#define analogInPinToBit(P) (P) +#define portOutputRegister(P) ( (volatile uint8_t *)( pgm_read_word( port_to_output_PGM + (P))) ) +#define portInputRegister(P) ( (volatile uint8_t *)( pgm_read_word( port_to_input_PGM + (P))) ) +#define portModeRegister(P) ( (volatile uint8_t *)( pgm_read_word( port_to_mode_PGM + (P))) ) + +#define NOT_A_PIN 0 +#define NOT_A_PORT 0 + +#define NOT_AN_INTERRUPT -1 + +#ifdef ARDUINO_MAIN +#define PA 1 +#define PB 2 +#define PC 3 +#define PD 4 +#define PE 5 +#define PF 6 +#define PG 7 +#define PH 8 +#define PJ 10 +#define PK 11 +#define PL 12 +#endif + +#define NOT_ON_TIMER 0 +#define TIMER0A 1 +#define TIMER0B 2 +#define TIMER1A 3 +#define TIMER1B 4 +#define TIMER1C 5 +#define TIMER2  6 +#define TIMER2A 7 +#define TIMER2B 8 + +#define TIMER3A 9 +#define TIMER3B 10 +#define TIMER3C 11 +#define TIMER4A 12 +#define TIMER4B 13 +#define TIMER4C 14 +#define TIMER4D 15 +#define TIMER5A 16 +#define TIMER5B 17 +#define TIMER5C 18 + +#ifdef __cplusplus +} // extern "C" +#endif + +#ifdef __cplusplus +#include "WCharacter.h" +#include "WString.h" +#include "HardwareSerial.h" +#include "USBAPI.h" +#if defined(HAVE_HWSERIAL0) && defined(HAVE_CDCSERIAL) +#error "Targets with both UART0 and CDC serial not supported" +#endif + +uint16_t makeWord(uint16_t w); +uint16_t makeWord(byte h, byte l); + +#define word(...) makeWord(__VA_ARGS__) + +unsigned long pulseIn(uint8_t pin, uint8_t state, unsigned long timeout = 1000000L); +unsigned long pulseInLong(uint8_t pin, uint8_t state, unsigned long timeout = 1000000L); + +void tone(uint8_t _pin, unsigned int frequency, unsigned long duration = 0); +void noTone(uint8_t _pin); + +// WMath prototypes +long random(long); +long random(long, long); +void randomSeed(unsigned long); +long map(long, long, long, long, long); + +#endif + +#include "pins_arduino.h" + +#endif diff --git a/cores/xinput/CDC.cpp b/cores/xinput/CDC.cpp new file mode 100644 index 0000000..a6bce17 --- /dev/null +++ b/cores/xinput/CDC.cpp @@ -0,0 +1,25 @@ + + +/* Copyright (c) 2011, Peter Barrett   +**   +** Permission to use, copy, modify, and/or distribute this software for   +** any purpose with or without fee is hereby granted, provided that the   +** above copyright notice and this permission notice appear in all copies.   +**  +** THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL   +** WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED   +** WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR   +** BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES   +** OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,   +** WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,   +** ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS   +** SOFTWARE.   +*/ + +#include "USBAPI.h" + +#if defined(USBCON) + +Serial_ Serial; + +#endif /* if defined(USBCON) */ diff --git a/cores/xinput/Client.h b/cores/xinput/Client.h new file mode 100644 index 0000000..b8e5d93 --- /dev/null +++ b/cores/xinput/Client.h @@ -0,0 +1,45 @@ +/* +  Client.h - Base class that provides Client +  Copyright (c) 2011 Adrian McEwen.  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 +*/ + +#ifndef client_h +#define client_h +#include "Print.h" +#include "Stream.h" +#include "IPAddress.h" + +class Client : public Stream { + +public: +  virtual int connect(IPAddress ip, uint16_t port) =0; +  virtual int connect(const char *host, uint16_t port) =0; +  virtual size_t write(uint8_t) =0; +  virtual size_t write(const uint8_t *buf, size_t size) =0; +  virtual int available() = 0; +  virtual int read() = 0; +  virtual int read(uint8_t *buf, size_t size) = 0; +  virtual int peek() = 0; +  virtual void flush() = 0; +  virtual void stop() = 0; +  virtual uint8_t connected() = 0; +  virtual operator bool() = 0; +protected: +  uint8_t* rawIPAddress(IPAddress& addr) { return addr.raw_address(); }; +}; + +#endif diff --git a/cores/xinput/HardwareSerial.cpp b/cores/xinput/HardwareSerial.cpp new file mode 100644 index 0000000..561127f --- /dev/null +++ b/cores/xinput/HardwareSerial.cpp @@ -0,0 +1,281 @@ +/* +  HardwareSerial.cpp - Hardware serial library for Wiring +  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 +   +  Modified 23 November 2006 by David A. Mellis +  Modified 28 September 2010 by Mark Sproul +  Modified 14 August 2012 by Alarus +  Modified 3 December 2013 by Matthijs Kooijman +*/ + +#include <stdlib.h> +#include <stdio.h> +#include <string.h> +#include <inttypes.h> +#include <util/atomic.h> +#include "Arduino.h" + +#include "HardwareSerial.h" +#include "HardwareSerial_private.h" + +// this next line disables the entire HardwareSerial.cpp,  +// this is so I can support Attiny series and any other chip without a uart +#if defined(HAVE_HWSERIAL0) || defined(HAVE_HWSERIAL1) || defined(HAVE_HWSERIAL2) || defined(HAVE_HWSERIAL3) + +// SerialEvent functions are weak, so when the user doesn't define them, +// the linker just sets their address to 0 (which is checked below). +// The Serialx_available is just a wrapper around Serialx.available(), +// but we can refer to it weakly so we don't pull in the entire +// HardwareSerial instance if the user doesn't also refer to it. +#if defined(HAVE_HWSERIAL0) +  void serialEvent() __attribute__((weak)); +  bool Serial0_available() __attribute__((weak)); +#endif + +#if defined(HAVE_HWSERIAL1) +  void serialEvent1() __attribute__((weak)); +  bool Serial1_available() __attribute__((weak)); +#endif + +#if defined(HAVE_HWSERIAL2) +  void serialEvent2() __attribute__((weak)); +  bool Serial2_available() __attribute__((weak)); +#endif + +#if defined(HAVE_HWSERIAL3) +  void serialEvent3() __attribute__((weak)); +  bool Serial3_available() __attribute__((weak)); +#endif + +void serialEventRun(void) +{ +#if defined(HAVE_HWSERIAL0) +  if (Serial0_available && serialEvent && Serial0_available()) serialEvent(); +#endif +#if defined(HAVE_HWSERIAL1) +  if (Serial1_available && serialEvent1 && Serial1_available()) serialEvent1(); +#endif +#if defined(HAVE_HWSERIAL2) +  if (Serial2_available && serialEvent2 && Serial2_available()) serialEvent2(); +#endif +#if defined(HAVE_HWSERIAL3) +  if (Serial3_available && serialEvent3 && Serial3_available()) serialEvent3(); +#endif +} + +// macro to guard critical sections when needed for large TX buffer sizes +#if (SERIAL_TX_BUFFER_SIZE>256) +#define TX_BUFFER_ATOMIC ATOMIC_BLOCK(ATOMIC_RESTORESTATE) +#else +#define TX_BUFFER_ATOMIC +#endif + +// Actual interrupt handlers ////////////////////////////////////////////////////////////// + +void HardwareSerial::_tx_udr_empty_irq(void) +{ +  // If interrupts are enabled, there must be more data in the output +  // buffer. Send the next byte +  unsigned char c = _tx_buffer[_tx_buffer_tail]; +  _tx_buffer_tail = (_tx_buffer_tail + 1) % SERIAL_TX_BUFFER_SIZE; + +  *_udr = c; + +  // clear the TXC bit -- "can be cleared by writing a one to its bit +  // location". This makes sure flush() won't return until the bytes +  // actually got written. Other r/w bits are preserved, and zeroes +  // written to the rest. + +#ifdef MPCM0 +  *_ucsra = ((*_ucsra) & ((1 << U2X0) | (1 << MPCM0))) | (1 << TXC0); +#else +  *_ucsra = ((*_ucsra) & ((1 << U2X0) | (1 << TXC0))); +#endif + +  if (_tx_buffer_head == _tx_buffer_tail) { +    // Buffer empty, so disable interrupts +    cbi(*_ucsrb, UDRIE0); +  } +} + +// Public Methods ////////////////////////////////////////////////////////////// + +void HardwareSerial::begin(unsigned long baud, byte config) +{ +  // Try u2x mode first +  uint16_t baud_setting = (F_CPU / 4 / baud - 1) / 2; +  *_ucsra = 1 << U2X0; + +  // hardcoded exception for 57600 for compatibility with the bootloader +  // shipped with the Duemilanove and previous boards and the firmware +  // on the 8U2 on the Uno and Mega 2560. Also, The baud_setting cannot +  // be > 4095, so switch back to non-u2x mode if the baud rate is too +  // low. +  if (((F_CPU == 16000000UL) && (baud == 57600)) || (baud_setting >4095)) +  { +    *_ucsra = 0; +    baud_setting = (F_CPU / 8 / baud - 1) / 2; +  } + +  // assign the baud_setting, a.k.a. ubrr (USART Baud Rate Register) +  *_ubrrh = baud_setting >> 8; +  *_ubrrl = baud_setting; + +  _written = false; + +  //set the data bits, parity, and stop bits +#if defined(__AVR_ATmega8__) +  config |= 0x80; // select UCSRC register (shared with UBRRH) +#endif +  *_ucsrc = config; +   +  sbi(*_ucsrb, RXEN0); +  sbi(*_ucsrb, TXEN0); +  sbi(*_ucsrb, RXCIE0); +  cbi(*_ucsrb, UDRIE0); +} + +void HardwareSerial::end() +{ +  // wait for transmission of outgoing data +  flush(); + +  cbi(*_ucsrb, RXEN0); +  cbi(*_ucsrb, TXEN0); +  cbi(*_ucsrb, RXCIE0); +  cbi(*_ucsrb, UDRIE0); +   +  // clear any received data +  _rx_buffer_head = _rx_buffer_tail; +} + +int HardwareSerial::available(void) +{ +  return ((unsigned int)(SERIAL_RX_BUFFER_SIZE + _rx_buffer_head - _rx_buffer_tail)) % SERIAL_RX_BUFFER_SIZE; +} + +int HardwareSerial::peek(void) +{ +  if (_rx_buffer_head == _rx_buffer_tail) { +    return -1; +  } else { +    return _rx_buffer[_rx_buffer_tail]; +  } +} + +int HardwareSerial::read(void) +{ +  // if the head isn't ahead of the tail, we don't have any characters +  if (_rx_buffer_head == _rx_buffer_tail) { +    return -1; +  } else { +    unsigned char c = _rx_buffer[_rx_buffer_tail]; +    _rx_buffer_tail = (rx_buffer_index_t)(_rx_buffer_tail + 1) % SERIAL_RX_BUFFER_SIZE; +    return c; +  } +} + +int HardwareSerial::availableForWrite(void) +{ +  tx_buffer_index_t head; +  tx_buffer_index_t tail; + +  TX_BUFFER_ATOMIC { +    head = _tx_buffer_head; +    tail = _tx_buffer_tail; +  } +  if (head >= tail) return SERIAL_TX_BUFFER_SIZE - 1 - head + tail; +  return tail - head - 1; +} + +void HardwareSerial::flush() +{ +  // If we have never written a byte, no need to flush. This special +  // case is needed since there is no way to force the TXC (transmit +  // complete) bit to 1 during initialization +  if (!_written) +    return; + +  while (bit_is_set(*_ucsrb, UDRIE0) || bit_is_clear(*_ucsra, TXC0)) { +    if (bit_is_clear(SREG, SREG_I) && bit_is_set(*_ucsrb, UDRIE0)) +	// Interrupts are globally disabled, but the DR empty +	// interrupt should be enabled, so poll the DR empty flag to +	// prevent deadlock +	if (bit_is_set(*_ucsra, UDRE0)) +	  _tx_udr_empty_irq(); +  } +  // If we get here, nothing is queued anymore (DRIE is disabled) and +  // the hardware finished transmission (TXC is set). +} + +size_t HardwareSerial::write(uint8_t c) +{ +  _written = true; +  // If the buffer and the data register is empty, just write the byte +  // to the data register and be done. This shortcut helps +  // significantly improve the effective datarate at high (> +  // 500kbit/s) bitrates, where interrupt overhead becomes a slowdown. +  if (_tx_buffer_head == _tx_buffer_tail && bit_is_set(*_ucsra, UDRE0)) { +    // If TXC is cleared before writing UDR and the previous byte +    // completes before writing to UDR, TXC will be set but a byte +    // is still being transmitted causing flush() to return too soon. +    // So writing UDR must happen first. +    // Writing UDR and clearing TC must be done atomically, otherwise +    // interrupts might delay the TXC clear so the byte written to UDR +    // is transmitted (setting TXC) before clearing TXC. Then TXC will +    // be cleared when no bytes are left, causing flush() to hang +    ATOMIC_BLOCK(ATOMIC_RESTORESTATE) { +      *_udr = c; +#ifdef MPCM0 +      *_ucsra = ((*_ucsra) & ((1 << U2X0) | (1 << MPCM0))) | (1 << TXC0); +#else +      *_ucsra = ((*_ucsra) & ((1 << U2X0) | (1 << TXC0))); +#endif +    } +    return 1; +  } +  tx_buffer_index_t i = (_tx_buffer_head + 1) % SERIAL_TX_BUFFER_SIZE; +	 +  // If the output buffer is full, there's nothing for it other than to  +  // wait for the interrupt handler to empty it a bit +  while (i == _tx_buffer_tail) { +    if (bit_is_clear(SREG, SREG_I)) { +      // Interrupts are disabled, so we'll have to poll the data +      // register empty flag ourselves. If it is set, pretend an +      // interrupt has happened and call the handler to free up +      // space for us. +      if(bit_is_set(*_ucsra, UDRE0)) +	_tx_udr_empty_irq(); +    } else { +      // nop, the interrupt handler will free up space for us +    } +  } + +  _tx_buffer[_tx_buffer_head] = c; + +  // make atomic to prevent execution of ISR between setting the +  // head pointer and setting the interrupt flag resulting in buffer +  // retransmission +  ATOMIC_BLOCK(ATOMIC_RESTORESTATE) { +    _tx_buffer_head = i; +    sbi(*_ucsrb, UDRIE0); +  } +   +  return 1; +} + +#endif // whole file diff --git a/cores/xinput/HardwareSerial.h b/cores/xinput/HardwareSerial.h new file mode 100644 index 0000000..6ff29d0 --- /dev/null +++ b/cores/xinput/HardwareSerial.h @@ -0,0 +1,161 @@ +/* +  HardwareSerial.h - Hardware serial library for Wiring +  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 + +  Modified 28 September 2010 by Mark Sproul +  Modified 14 August 2012 by Alarus +  Modified 3 December 2013 by Matthijs Kooijman +*/ + +#ifndef HardwareSerial_h +#define HardwareSerial_h + +#include <inttypes.h> + +#include "Stream.h" + +// Define constants and variables for buffering incoming serial data.  We're +// using a ring buffer (I think), in which head is the index of the location +// to which to write the next incoming character and tail is the index of the +// location from which to read. +// NOTE: a "power of 2" buffer size is recommended to dramatically +//       optimize all the modulo operations for ring buffers. +// WARNING: When buffer sizes are increased to > 256, the buffer index +// variables are automatically increased in size, but the extra +// atomicity guards needed for that are not implemented. This will +// often work, but occasionally a race condition can occur that makes +// Serial behave erratically. See https://github.com/arduino/Arduino/issues/2405 +#if !defined(SERIAL_TX_BUFFER_SIZE) +#if ((RAMEND - RAMSTART) < 1023) +#define SERIAL_TX_BUFFER_SIZE 16 +#else +#define SERIAL_TX_BUFFER_SIZE 64 +#endif +#endif +#if !defined(SERIAL_RX_BUFFER_SIZE) +#if ((RAMEND - RAMSTART) < 1023) +#define SERIAL_RX_BUFFER_SIZE 16 +#else +#define SERIAL_RX_BUFFER_SIZE 64 +#endif +#endif +#if (SERIAL_TX_BUFFER_SIZE>256) +typedef uint16_t tx_buffer_index_t; +#else +typedef uint8_t tx_buffer_index_t; +#endif +#if  (SERIAL_RX_BUFFER_SIZE>256) +typedef uint16_t rx_buffer_index_t; +#else +typedef uint8_t rx_buffer_index_t; +#endif + +// Define config for Serial.begin(baud, config); +#define SERIAL_5N1 0x00 +#define SERIAL_6N1 0x02 +#define SERIAL_7N1 0x04 +#define SERIAL_8N1 0x06 +#define SERIAL_5N2 0x08 +#define SERIAL_6N2 0x0A +#define SERIAL_7N2 0x0C +#define SERIAL_8N2 0x0E +#define SERIAL_5E1 0x20 +#define SERIAL_6E1 0x22 +#define SERIAL_7E1 0x24 +#define SERIAL_8E1 0x26 +#define SERIAL_5E2 0x28 +#define SERIAL_6E2 0x2A +#define SERIAL_7E2 0x2C +#define SERIAL_8E2 0x2E +#define SERIAL_5O1 0x30 +#define SERIAL_6O1 0x32 +#define SERIAL_7O1 0x34 +#define SERIAL_8O1 0x36 +#define SERIAL_5O2 0x38 +#define SERIAL_6O2 0x3A +#define SERIAL_7O2 0x3C +#define SERIAL_8O2 0x3E + +class HardwareSerial : public Stream +{ +  protected: +    volatile uint8_t * const _ubrrh; +    volatile uint8_t * const _ubrrl; +    volatile uint8_t * const _ucsra; +    volatile uint8_t * const _ucsrb; +    volatile uint8_t * const _ucsrc; +    volatile uint8_t * const _udr; +    // Has any byte been written to the UART since begin() +    bool _written; + +    volatile rx_buffer_index_t _rx_buffer_head; +    volatile rx_buffer_index_t _rx_buffer_tail; +    volatile tx_buffer_index_t _tx_buffer_head; +    volatile tx_buffer_index_t _tx_buffer_tail; + +    // Don't put any members after these buffers, since only the first +    // 32 bytes of this struct can be accessed quickly using the ldd +    // instruction. +    unsigned char _rx_buffer[SERIAL_RX_BUFFER_SIZE]; +    unsigned char _tx_buffer[SERIAL_TX_BUFFER_SIZE]; + +  public: +    inline HardwareSerial( +      volatile uint8_t *ubrrh, volatile uint8_t *ubrrl, +      volatile uint8_t *ucsra, volatile uint8_t *ucsrb, +      volatile uint8_t *ucsrc, volatile uint8_t *udr); +    void begin(unsigned long baud) { begin(baud, SERIAL_8N1); } +    void begin(unsigned long, uint8_t); +    void end(); +    virtual int available(void); +    virtual int peek(void); +    virtual int read(void); +    virtual int availableForWrite(void); +    virtual void flush(void); +    virtual size_t write(uint8_t); +    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; // pull in write(str) and write(buf, size) from Print +    operator bool() { return true; } + +    // Interrupt handlers - Not intended to be called externally +    inline void _rx_complete_irq(void); +    void _tx_udr_empty_irq(void); +}; + +#if defined(UBRRH) || defined(UBRR0H) +  extern HardwareSerial Serial; +  #define HAVE_HWSERIAL0 +#endif +#if defined(UBRR1H) +  extern HardwareSerial Serial1; +  #define HAVE_HWSERIAL1 +#endif +#if defined(UBRR2H) +  extern HardwareSerial Serial2; +  #define HAVE_HWSERIAL2 +#endif +#if defined(UBRR3H) +  extern HardwareSerial Serial3; +  #define HAVE_HWSERIAL3 +#endif + +extern void serialEventRun(void) __attribute__((weak)); + +#endif diff --git a/cores/xinput/HardwareSerial0.cpp b/cores/xinput/HardwareSerial0.cpp new file mode 100644 index 0000000..7d47ed2 --- /dev/null +++ b/cores/xinput/HardwareSerial0.cpp @@ -0,0 +1,79 @@ +/* +  HardwareSerial0.cpp - Hardware serial library for Wiring +  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 + +  Modified 23 November 2006 by David A. Mellis +  Modified 28 September 2010 by Mark Sproul +  Modified 14 August 2012 by Alarus +  Modified 3 December 2013 by Matthijs Kooijman +*/ + +#include "Arduino.h" +#include "HardwareSerial.h" +#include "HardwareSerial_private.h" + +// Each HardwareSerial is defined in its own file, since the linker pulls +// in the entire file when any element inside is used. --gc-sections can +// additionally cause unused symbols to be dropped, but ISRs have the +// "used" attribute so are never dropped and they keep the +// HardwareSerial instance in as well. Putting each instance in its own +// file prevents the linker from pulling in any unused instances in the +// first place. + +#if defined(HAVE_HWSERIAL0) + +#if defined(USART_RX_vect) +  ISR(USART_RX_vect) +#elif defined(USART0_RX_vect) +  ISR(USART0_RX_vect) +#elif defined(USART_RXC_vect) +  ISR(USART_RXC_vect) // ATmega8 +#else +  #error "Don't know what the Data Received vector is called for Serial" +#endif +  { +    Serial._rx_complete_irq(); +  } + +#if defined(UART0_UDRE_vect) +ISR(UART0_UDRE_vect) +#elif defined(UART_UDRE_vect) +ISR(UART_UDRE_vect) +#elif defined(USART0_UDRE_vect) +ISR(USART0_UDRE_vect) +#elif defined(USART_UDRE_vect) +ISR(USART_UDRE_vect) +#else +  #error "Don't know what the Data Register Empty vector is called for Serial" +#endif +{ +  Serial._tx_udr_empty_irq(); +} + +#if defined(UBRRH) && defined(UBRRL) +  HardwareSerial Serial(&UBRRH, &UBRRL, &UCSRA, &UCSRB, &UCSRC, &UDR); +#else +  HardwareSerial Serial(&UBRR0H, &UBRR0L, &UCSR0A, &UCSR0B, &UCSR0C, &UDR0); +#endif + +// Function that can be weakly referenced by serialEventRun to prevent +// pulling in this file if it's not otherwise used. +bool Serial0_available() { +  return Serial.available(); +} + +#endif // HAVE_HWSERIAL0 diff --git a/cores/xinput/HardwareSerial1.cpp b/cores/xinput/HardwareSerial1.cpp new file mode 100644 index 0000000..a345cdb --- /dev/null +++ b/cores/xinput/HardwareSerial1.cpp @@ -0,0 +1,69 @@ +/* +  HardwareSerial1.cpp - Hardware serial library for Wiring +  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 + +  Modified 23 November 2006 by David A. Mellis +  Modified 28 September 2010 by Mark Sproul +  Modified 14 August 2012 by Alarus +  Modified 3 December 2013 by Matthijs Kooijman +*/ + +#include "Arduino.h" +#include "HardwareSerial.h" +#include "HardwareSerial_private.h" + +// Each HardwareSerial is defined in its own file, since the linker pulls +// in the entire file when any element inside is used. --gc-sections can +// additionally cause unused symbols to be dropped, but ISRs have the +// "used" attribute so are never dropped and they keep the +// HardwareSerial instance in as well. Putting each instance in its own +// file prevents the linker from pulling in any unused instances in the +// first place. + +#if defined(HAVE_HWSERIAL1) + +#if defined(UART1_RX_vect) +ISR(UART1_RX_vect) +#elif defined(USART1_RX_vect) +ISR(USART1_RX_vect) +#else +#error "Don't know what the Data Register Empty vector is called for Serial1" +#endif +{ +  Serial1._rx_complete_irq(); +} + +#if defined(UART1_UDRE_vect) +ISR(UART1_UDRE_vect) +#elif defined(USART1_UDRE_vect) +ISR(USART1_UDRE_vect) +#else +#error "Don't know what the Data Register Empty vector is called for Serial1" +#endif +{ +  Serial1._tx_udr_empty_irq(); +} + +HardwareSerial Serial1(&UBRR1H, &UBRR1L, &UCSR1A, &UCSR1B, &UCSR1C, &UDR1); + +// Function that can be weakly referenced by serialEventRun to prevent +// pulling in this file if it's not otherwise used. +bool Serial1_available() { +  return Serial1.available(); +} + +#endif // HAVE_HWSERIAL1 diff --git a/cores/xinput/HardwareSerial2.cpp b/cores/xinput/HardwareSerial2.cpp new file mode 100644 index 0000000..8e433b6 --- /dev/null +++ b/cores/xinput/HardwareSerial2.cpp @@ -0,0 +1,57 @@ +/* +  HardwareSerial2.cpp - Hardware serial library for Wiring +  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 + +  Modified 23 November 2006 by David A. Mellis +  Modified 28 September 2010 by Mark Sproul +  Modified 14 August 2012 by Alarus +  Modified 3 December 2013 by Matthijs Kooijman +*/ + +#include "Arduino.h" +#include "HardwareSerial.h" +#include "HardwareSerial_private.h" + +// Each HardwareSerial is defined in its own file, since the linker pulls +// in the entire file when any element inside is used. --gc-sections can +// additionally cause unused symbols to be dropped, but ISRs have the +// "used" attribute so are never dropped and they keep the +// HardwareSerial instance in as well. Putting each instance in its own +// file prevents the linker from pulling in any unused instances in the +// first place. + +#if defined(HAVE_HWSERIAL2) + +ISR(USART2_RX_vect) +{ +  Serial2._rx_complete_irq(); +} + +ISR(USART2_UDRE_vect) +{ +  Serial2._tx_udr_empty_irq(); +} + +HardwareSerial Serial2(&UBRR2H, &UBRR2L, &UCSR2A, &UCSR2B, &UCSR2C, &UDR2); + +// Function that can be weakly referenced by serialEventRun to prevent +// pulling in this file if it's not otherwise used. +bool Serial2_available() { +  return Serial2.available(); +} + +#endif // HAVE_HWSERIAL2 diff --git a/cores/xinput/HardwareSerial3.cpp b/cores/xinput/HardwareSerial3.cpp new file mode 100644 index 0000000..26aaee8 --- /dev/null +++ b/cores/xinput/HardwareSerial3.cpp @@ -0,0 +1,57 @@ +/* +  HardwareSerial3.cpp - Hardware serial library for Wiring +  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 + +  Modified 23 November 2006 by David A. Mellis +  Modified 28 September 2010 by Mark Sproul +  Modified 14 August 2012 by Alarus +  Modified 3 December 2013 by Matthijs Kooijman +*/ + +#include "Arduino.h" +#include "HardwareSerial.h" +#include "HardwareSerial_private.h" + +// Each HardwareSerial is defined in its own file, since the linker pulls +// in the entire file when any element inside is used. --gc-sections can +// additionally cause unused symbols to be dropped, but ISRs have the +// "used" attribute so are never dropped and they keep the +// HardwareSerial instance in as well. Putting each instance in its own +// file prevents the linker from pulling in any unused instances in the +// first place. + +#if defined(HAVE_HWSERIAL3) + +ISR(USART3_RX_vect) +{ +  Serial3._rx_complete_irq(); +} + +ISR(USART3_UDRE_vect) +{ +  Serial3._tx_udr_empty_irq(); +} + +HardwareSerial Serial3(&UBRR3H, &UBRR3L, &UCSR3A, &UCSR3B, &UCSR3C, &UDR3); + +// Function that can be weakly referenced by serialEventRun to prevent +// pulling in this file if it's not otherwise used. +bool Serial3_available() { +  return Serial3.available(); +} + +#endif // HAVE_HWSERIAL3 diff --git a/cores/xinput/HardwareSerial_private.h b/cores/xinput/HardwareSerial_private.h new file mode 100644 index 0000000..2e23cec --- /dev/null +++ b/cores/xinput/HardwareSerial_private.h @@ -0,0 +1,123 @@ +/* +  HardwareSerial_private.h - Hardware serial library for Wiring +  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 + +  Modified 23 November 2006 by David A. Mellis +  Modified 28 September 2010 by Mark Sproul +  Modified 14 August 2012 by Alarus +*/ + +#include "wiring_private.h" + +// this next line disables the entire HardwareSerial.cpp,  +// this is so I can support Attiny series and any other chip without a uart +#if defined(HAVE_HWSERIAL0) || defined(HAVE_HWSERIAL1) || defined(HAVE_HWSERIAL2) || defined(HAVE_HWSERIAL3) + +// Ensure that the various bit positions we use are available with a 0 +// postfix, so we can always use the values for UART0 for all UARTs. The +// alternative, passing the various values for each UART to the +// HardwareSerial constructor also works, but makes the code bigger and +// slower. +#if !defined(TXC0) +#if defined(TXC) +// Some chips like ATmega8 don't have UPE, only PE. The other bits are +// named as expected. +#if !defined(UPE) && defined(PE) +#define UPE PE +#endif +// On ATmega8, the uart and its bits are not numbered, so there is no TXC0 etc. +#define TXC0 TXC +#define RXEN0 RXEN +#define TXEN0 TXEN +#define RXCIE0 RXCIE +#define UDRIE0 UDRIE +#define U2X0 U2X +#define UPE0 UPE +#define UDRE0 UDRE +#elif defined(TXC1) +// Some devices have uart1 but no uart0 +#define TXC0 TXC1 +#define RXEN0 RXEN1 +#define TXEN0 TXEN1 +#define RXCIE0 RXCIE1 +#define UDRIE0 UDRIE1 +#define U2X0 U2X1 +#define UPE0 UPE1 +#define UDRE0 UDRE1 +#else +#error No UART found in HardwareSerial.cpp +#endif +#endif // !defined TXC0 + +// Check at compile time that it is really ok to use the bit positions of +// UART0 for the other UARTs as well, in case these values ever get +// changed for future hardware. +#if defined(TXC1) && (TXC1 != TXC0 || RXEN1 != RXEN0 || RXCIE1 != RXCIE0 || \ +		      UDRIE1 != UDRIE0 || U2X1 != U2X0 || UPE1 != UPE0 || \ +		      UDRE1 != UDRE0) +#error "Not all bit positions for UART1 are the same as for UART0" +#endif +#if defined(TXC2) && (TXC2 != TXC0 || RXEN2 != RXEN0 || RXCIE2 != RXCIE0 || \ +		      UDRIE2 != UDRIE0 || U2X2 != U2X0 || UPE2 != UPE0 || \ +		      UDRE2 != UDRE0) +#error "Not all bit positions for UART2 are the same as for UART0" +#endif +#if defined(TXC3) && (TXC3 != TXC0 || RXEN3 != RXEN0 || RXCIE3 != RXCIE0 || \ +		      UDRIE3 != UDRIE0 || U3X3 != U3X0 || UPE3 != UPE0 || \ +		      UDRE3 != UDRE0) +#error "Not all bit positions for UART3 are the same as for UART0" +#endif + +// Constructors //////////////////////////////////////////////////////////////// + +HardwareSerial::HardwareSerial( +  volatile uint8_t *ubrrh, volatile uint8_t *ubrrl, +  volatile uint8_t *ucsra, volatile uint8_t *ucsrb, +  volatile uint8_t *ucsrc, volatile uint8_t *udr) : +    _ubrrh(ubrrh), _ubrrl(ubrrl), +    _ucsra(ucsra), _ucsrb(ucsrb), _ucsrc(ucsrc), +    _udr(udr), +    _rx_buffer_head(0), _rx_buffer_tail(0), +    _tx_buffer_head(0), _tx_buffer_tail(0) +{ +} + +// Actual interrupt handlers ////////////////////////////////////////////////////////////// + +void HardwareSerial::_rx_complete_irq(void) +{ +  if (bit_is_clear(*_ucsra, UPE0)) { +    // No Parity error, read byte and store it in the buffer if there is +    // room +    unsigned char c = *_udr; +    rx_buffer_index_t i = (unsigned int)(_rx_buffer_head + 1) % SERIAL_RX_BUFFER_SIZE; + +    // if we should be storing the received character into the location +    // just before the tail (meaning that the head would advance to the +    // current location of the tail), we're about to overflow the buffer +    // and so we don't write the character or advance the head. +    if (i != _rx_buffer_tail) { +      _rx_buffer[_rx_buffer_head] = c; +      _rx_buffer_head = i; +    } +  } else { +    // Parity error, read byte but discard it +    *_udr; +  }; +} + +#endif // whole file diff --git a/cores/xinput/IPAddress.cpp b/cores/xinput/IPAddress.cpp new file mode 100644 index 0000000..d9fe5be --- /dev/null +++ b/cores/xinput/IPAddress.cpp @@ -0,0 +1,114 @@ +/* +  IPAddress.cpp - Base class that provides IPAddress +  Copyright (c) 2011 Adrian McEwen.  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 +*/ + +#include <Arduino.h> +#include <IPAddress.h> + +IPAddress::IPAddress() +{ +    _address.dword = 0; +} + +IPAddress::IPAddress(uint8_t first_octet, uint8_t second_octet, uint8_t third_octet, uint8_t fourth_octet) +{ +    _address.bytes[0] = first_octet; +    _address.bytes[1] = second_octet; +    _address.bytes[2] = third_octet; +    _address.bytes[3] = fourth_octet; +} + +IPAddress::IPAddress(uint32_t address) +{ +    _address.dword = address; +} + +IPAddress::IPAddress(const uint8_t *address) +{ +    memcpy(_address.bytes, address, sizeof(_address.bytes)); +} + +bool IPAddress::fromString(const char *address) +{ +    uint16_t acc = 0; // Accumulator +    uint8_t dots = 0; + +    while (*address) +    { +        char c = *address++; +        if (c >= '0' && c <= '9') +        { +            acc = acc * 10 + (c - '0'); +            if (acc > 255) { +                // Value out of [0..255] range +                return false; +            } +        } +        else if (c == '.') +        { +            if (dots == 3) { +                // Too much dots (there must be 3 dots) +                return false; +            } +            _address.bytes[dots++] = acc; +            acc = 0; +        } +        else +        { +            // Invalid char +            return false; +        } +    } + +    if (dots != 3) { +        // Too few dots (there must be 3 dots) +        return false; +    } +    _address.bytes[3] = acc; +    return true; +} + +IPAddress& IPAddress::operator=(const uint8_t *address) +{ +    memcpy(_address.bytes, address, sizeof(_address.bytes)); +    return *this; +} + +IPAddress& IPAddress::operator=(uint32_t address) +{ +    _address.dword = address; +    return *this; +} + +bool IPAddress::operator==(const uint8_t* addr) const +{ +    return memcmp(addr, _address.bytes, sizeof(_address.bytes)) == 0; +} + +size_t IPAddress::printTo(Print& p) const +{ +    size_t n = 0; +    for (int i =0; i < 3; i++) +    { +        n += p.print(_address.bytes[i], DEC); +        n += p.print('.'); +    } +    n += p.print(_address.bytes[3], DEC); +    return n; +} + diff --git a/cores/xinput/IPAddress.h b/cores/xinput/IPAddress.h new file mode 100644 index 0000000..d762f2c --- /dev/null +++ b/cores/xinput/IPAddress.h @@ -0,0 +1,78 @@ +/* +  IPAddress.h - Base class that provides IPAddress +  Copyright (c) 2011 Adrian McEwen.  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 +*/ + +#ifndef IPAddress_h +#define IPAddress_h + +#include <stdint.h> +#include "Printable.h" +#include "WString.h" + +// A class to make it easier to handle and pass around IP addresses + +class IPAddress : public Printable { +private: +    union { +	uint8_t bytes[4];  // IPv4 address +	uint32_t dword; +    } _address; + +    // Access the raw byte array containing the address.  Because this returns a pointer +    // to the internal structure rather than a copy of the address this function should only +    // be used when you know that the usage of the returned uint8_t* will be transient and not +    // stored. +    uint8_t* raw_address() { return _address.bytes; }; + +public: +    // Constructors +    IPAddress(); +    IPAddress(uint8_t first_octet, uint8_t second_octet, uint8_t third_octet, uint8_t fourth_octet); +    IPAddress(uint32_t address); +    IPAddress(const uint8_t *address); + +    bool fromString(const char *address); +    bool fromString(const String &address) { return fromString(address.c_str()); } + +    // Overloaded cast operator to allow IPAddress objects to be used where a pointer +    // to a four-byte uint8_t array is expected +    operator uint32_t() const { return _address.dword; }; +    bool operator==(const IPAddress& addr) const { return _address.dword == addr._address.dword; }; +    bool operator==(const uint8_t* addr) const; + +    // Overloaded index operator to allow getting and setting individual octets of the address +    uint8_t operator[](int index) const { return _address.bytes[index]; }; +    uint8_t& operator[](int index) { return _address.bytes[index]; }; + +    // Overloaded copy operators to allow initialisation of IPAddress objects from other types +    IPAddress& operator=(const uint8_t *address); +    IPAddress& operator=(uint32_t address); + +    virtual size_t printTo(Print& p) const; + +    friend class EthernetClass; +    friend class UDP; +    friend class Client; +    friend class Server; +    friend class DhcpClass; +    friend class DNSClient; +}; + +const IPAddress INADDR_NONE(0,0,0,0); + +#endif diff --git a/cores/xinput/PluggableUSB.cpp b/cores/xinput/PluggableUSB.cpp new file mode 100644 index 0000000..c489d9f --- /dev/null +++ b/cores/xinput/PluggableUSB.cpp @@ -0,0 +1,115 @@ +/* +  PluggableUSB.cpp +  Copyright (c) 2015 Arduino LLC + +  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 +*/ + +#include "USBAPI.h" +#include "PluggableUSB.h" + +#if defined(USBCON)	 +#ifdef PLUGGABLE_USB_ENABLED + +extern uint8_t _initEndpoints[]; + +int PluggableUSB_::getInterface(uint8_t* interfaceCount) +{ +	int sent = 0; +	PluggableUSBModule* node; +	for (node = rootNode; node; node = node->next) { +		int res = node->getInterface(interfaceCount); +		if (res < 0) +			return -1; +		sent += res; +	} +	return sent; +} + +int PluggableUSB_::getDescriptor(USBSetup& setup) +{ +	PluggableUSBModule* node; +	for (node = rootNode; node; node = node->next) { +		int ret = node->getDescriptor(setup); +		// ret!=0 -> request has been processed +		if (ret) +			return ret; +	} +	return 0; +} + +void PluggableUSB_::getShortName(char *iSerialNum) +{ +	PluggableUSBModule* node; +	for (node = rootNode; node; node = node->next) { +		iSerialNum += node->getShortName(iSerialNum); +	} +	*iSerialNum = 0; +} + +bool PluggableUSB_::setup(USBSetup& setup) +{ +	PluggableUSBModule* node; +	for (node = rootNode; node; node = node->next) { +		if (node->setup(setup)) { +			return true; +		} +	} +	return false; +} + +bool PluggableUSB_::plug(PluggableUSBModule *node) +{ +	if ((lastEp + node->numEndpoints) > USB_ENDPOINTS) { +		return false; +	} + +	if (!rootNode) { +		rootNode = node; +	} else { +		PluggableUSBModule *current = rootNode; +		while (current->next) { +			current = current->next; +		} +		current->next = node; +	} + +	node->pluggedInterface = lastIf; +	node->pluggedEndpoint = lastEp; +	lastIf += node->numInterfaces; +	for (uint8_t i = 0; i < node->numEndpoints; i++) { +		_initEndpoints[lastEp] = node->endpointType[i]; +		lastEp++; +	} +	return true; +	// restart USB layer??? +} + +PluggableUSB_& PluggableUSB() +{ +	static PluggableUSB_ obj; +	return obj; +} + +PluggableUSB_::PluggableUSB_() : lastIf(CDC_ACM_INTERFACE + CDC_INTERFACE_COUNT), +                                 lastEp(CDC_FIRST_ENDPOINT + CDC_ENPOINT_COUNT), +                                 rootNode(NULL) +{ +	// Empty +} + +#endif + +#endif /* if defined(USBCON) */ diff --git a/cores/xinput/PluggableUSB.h b/cores/xinput/PluggableUSB.h new file mode 100644 index 0000000..507f0df --- /dev/null +++ b/cores/xinput/PluggableUSB.h @@ -0,0 +1,74 @@ +/* +  PluggableUSB.h +  Copyright (c) 2015 Arduino LLC + +  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 PUSB_h +#define PUSB_h + +#include "USBAPI.h" +#include <stdint.h> + +#if defined(USBCON) + +class PluggableUSBModule { +public: +  PluggableUSBModule(uint8_t numEps, uint8_t numIfs, uint8_t *epType) : +    numEndpoints(numEps), numInterfaces(numIfs), endpointType(epType) +  { } + +protected: +  virtual bool setup(USBSetup& setup) = 0; +  virtual int getInterface(uint8_t* interfaceCount) = 0; +  virtual int getDescriptor(USBSetup& setup) = 0; +  virtual uint8_t getShortName(char *name) { name[0] = 'A'+pluggedInterface; return 1; } + +  uint8_t pluggedInterface; +  uint8_t pluggedEndpoint; + +  const uint8_t numEndpoints; +  const uint8_t numInterfaces; +  const uint8_t *endpointType; + +  PluggableUSBModule *next = NULL; + +  friend class PluggableUSB_; +}; + +class PluggableUSB_ { +public: +  PluggableUSB_(); +  bool plug(PluggableUSBModule *node); +  int getInterface(uint8_t* interfaceCount); +  int getDescriptor(USBSetup& setup); +  bool setup(USBSetup& setup); +  void getShortName(char *iSerialNum); + +private: +  uint8_t lastIf; +  uint8_t lastEp; +  PluggableUSBModule* rootNode; +}; + +// Replacement for global singleton. +// This function prevents static-initialization-order-fiasco +// https://isocpp.org/wiki/faq/ctors#static-init-order-on-first-use +PluggableUSB_& PluggableUSB(); + +#endif + +#endif diff --git a/cores/xinput/Print.cpp b/cores/xinput/Print.cpp new file mode 100644 index 0000000..1e4c99a --- /dev/null +++ b/cores/xinput/Print.cpp @@ -0,0 +1,266 @@ +/* + Print.cpp - Base class that provides print() and println() + Copyright (c) 2008 David A. Mellis.  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 +  + Modified 23 November 2006 by David A. Mellis + Modified 03 August 2015 by Chuck Todd + */ + +#include <stdlib.h> +#include <stdio.h> +#include <string.h> +#include <math.h> +#include "Arduino.h" + +#include "Print.h" + +// Public Methods ////////////////////////////////////////////////////////////// + +/* default implementation: may be overridden */ +size_t Print::write(const uint8_t *buffer, size_t size) +{ +  size_t n = 0; +  while (size--) { +    if (write(*buffer++)) n++; +    else break; +  } +  return n; +} + +size_t Print::print(const __FlashStringHelper *ifsh) +{ +  PGM_P p = reinterpret_cast<PGM_P>(ifsh); +  size_t n = 0; +  while (1) { +    unsigned char c = pgm_read_byte(p++); +    if (c == 0) break; +    if (write(c)) n++; +    else break; +  } +  return n; +} + +size_t Print::print(const String &s) +{ +  return write(s.c_str(), s.length()); +} + +size_t Print::print(const char str[]) +{ +  return write(str); +} + +size_t Print::print(char c) +{ +  return write(c); +} + +size_t Print::print(unsigned char b, int base) +{ +  return print((unsigned long) b, base); +} + +size_t Print::print(int n, int base) +{ +  return print((long) n, base); +} + +size_t Print::print(unsigned int n, int base) +{ +  return print((unsigned long) n, base); +} + +size_t Print::print(long n, int base) +{ +  if (base == 0) { +    return write(n); +  } else if (base == 10) { +    if (n < 0) { +      int t = print('-'); +      n = -n; +      return printNumber(n, 10) + t; +    } +    return printNumber(n, 10); +  } else { +    return printNumber(n, base); +  } +} + +size_t Print::print(unsigned long n, int base) +{ +  if (base == 0) return write(n); +  else return printNumber(n, base); +} + +size_t Print::print(double n, int digits) +{ +  return printFloat(n, digits); +} + +size_t Print::println(const __FlashStringHelper *ifsh) +{ +  size_t n = print(ifsh); +  n += println(); +  return n; +} + +size_t Print::print(const Printable& x) +{ +  return x.printTo(*this); +} + +size_t Print::println(void) +{ +  return write("\r\n"); +} + +size_t Print::println(const String &s) +{ +  size_t n = print(s); +  n += println(); +  return n; +} + +size_t Print::println(const char c[]) +{ +  size_t n = print(c); +  n += println(); +  return n; +} + +size_t Print::println(char c) +{ +  size_t n = print(c); +  n += println(); +  return n; +} + +size_t Print::println(unsigned char b, int base) +{ +  size_t n = print(b, base); +  n += println(); +  return n; +} + +size_t Print::println(int num, int base) +{ +  size_t n = print(num, base); +  n += println(); +  return n; +} + +size_t Print::println(unsigned int num, int base) +{ +  size_t n = print(num, base); +  n += println(); +  return n; +} + +size_t Print::println(long num, int base) +{ +  size_t n = print(num, base); +  n += println(); +  return n; +} + +size_t Print::println(unsigned long num, int base) +{ +  size_t n = print(num, base); +  n += println(); +  return n; +} + +size_t Print::println(double num, int digits) +{ +  size_t n = print(num, digits); +  n += println(); +  return n; +} + +size_t Print::println(const Printable& x) +{ +  size_t n = print(x); +  n += println(); +  return n; +} + +// Private Methods ///////////////////////////////////////////////////////////// + +size_t Print::printNumber(unsigned long n, uint8_t base) +{ +  char buf[8 * sizeof(long) + 1]; // Assumes 8-bit chars plus zero byte. +  char *str = &buf[sizeof(buf) - 1]; + +  *str = '\0'; + +  // prevent crash if called with base == 1 +  if (base < 2) base = 10; + +  do { +    char c = n % base; +    n /= base; + +    *--str = c < 10 ? c + '0' : c + 'A' - 10; +  } while(n); + +  return write(str); +} + +size_t Print::printFloat(double number, uint8_t digits)  +{  +  size_t n = 0; +   +  if (isnan(number)) return print("nan"); +  if (isinf(number)) return print("inf"); +  if (number > 4294967040.0) return print ("ovf");  // constant determined empirically +  if (number <-4294967040.0) return print ("ovf");  // constant determined empirically +   +  // Handle negative numbers +  if (number < 0.0) +  { +     n += print('-'); +     number = -number; +  } + +  // Round correctly so that print(1.999, 2) prints as "2.00" +  double rounding = 0.5; +  for (uint8_t i=0; i<digits; ++i) +    rounding /= 10.0; +   +  number += rounding; + +  // Extract the integer part of the number and print it +  unsigned long int_part = (unsigned long)number; +  double remainder = number - (double)int_part; +  n += print(int_part); + +  // Print the decimal point, but only if there are digits beyond +  if (digits > 0) { +    n += print('.');  +  } + +  // Extract digits from the remainder one at a time +  while (digits-- > 0) +  { +    remainder *= 10.0; +    unsigned int toPrint = (unsigned int)(remainder); +    n += print(toPrint); +    remainder -= toPrint;  +  }  +   +  return n; +} diff --git a/cores/xinput/Print.h b/cores/xinput/Print.h new file mode 100644 index 0000000..0097cc1 --- /dev/null +++ b/cores/xinput/Print.h @@ -0,0 +1,93 @@ +/* +  Print.h - Base class that provides print() and println() +  Copyright (c) 2008 David A. Mellis.  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 +*/ + +#ifndef Print_h +#define Print_h + +#include <inttypes.h> +#include <stdio.h> // for size_t + +#include "WString.h" +#include "Printable.h" + +#define DEC 10 +#define HEX 16 +#define OCT 8 +#ifdef BIN // Prevent warnings if BIN is previously defined in "iotnx4.h" or similar +#undef BIN +#endif +#define BIN 2 + +class Print +{ +  private: +    int write_error; +    size_t printNumber(unsigned long, uint8_t); +    size_t printFloat(double, uint8_t); +  protected: +    void setWriteError(int err = 1) { write_error = err; } +  public: +    Print() : write_error(0) {} +   +    int getWriteError() { return write_error; } +    void clearWriteError() { setWriteError(0); } +   +    virtual size_t write(uint8_t) = 0; +    size_t write(const char *str) { +      if (str == NULL) return 0; +      return write((const uint8_t *)str, strlen(str)); +    } +    virtual size_t write(const uint8_t *buffer, size_t size); +    size_t write(const char *buffer, size_t size) { +      return write((const uint8_t *)buffer, size); +    } + +    // default to zero, meaning "a single write may block" +    // should be overridden by subclasses with buffering +    virtual int availableForWrite() { return 0; } + +    size_t print(const __FlashStringHelper *); +    size_t print(const String &); +    size_t print(const char[]); +    size_t print(char); +    size_t print(unsigned char, int = DEC); +    size_t print(int, int = DEC); +    size_t print(unsigned int, int = DEC); +    size_t print(long, int = DEC); +    size_t print(unsigned long, int = DEC); +    size_t print(double, int = 2); +    size_t print(const Printable&); + +    size_t println(const __FlashStringHelper *); +    size_t println(const String &s); +    size_t println(const char[]); +    size_t println(char); +    size_t println(unsigned char, int = DEC); +    size_t println(int, int = DEC); +    size_t println(unsigned int, int = DEC); +    size_t println(long, int = DEC); +    size_t println(unsigned long, int = DEC); +    size_t println(double, int = 2); +    size_t println(const Printable&); +    size_t println(void); + +    virtual void flush() { /* Empty implementation for backward compatibility */ } +}; + +#endif diff --git a/cores/xinput/Printable.h b/cores/xinput/Printable.h new file mode 100644 index 0000000..2a1b2e9 --- /dev/null +++ b/cores/xinput/Printable.h @@ -0,0 +1,40 @@ +/* +  Printable.h - Interface class that allows printing of complex types +  Copyright (c) 2011 Adrian McEwen.  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 +*/ + +#ifndef Printable_h +#define Printable_h + +#include <stdlib.h> + +class Print; + +/** The Printable class provides a way for new classes to allow themselves to be printed. +    By deriving from Printable and implementing the printTo method, it will then be possible +    for users to print out instances of this class by passing them into the usual +    Print::print and Print::println methods. +*/ + +class Printable +{ +  public: +    virtual size_t printTo(Print& p) const = 0; +}; + +#endif + diff --git a/cores/xinput/Server.h b/cores/xinput/Server.h new file mode 100644 index 0000000..69e3e39 --- /dev/null +++ b/cores/xinput/Server.h @@ -0,0 +1,30 @@ +/* +  Server.h - Base class that provides Server +  Copyright (c) 2011 Adrian McEwen.  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 +*/ + +#ifndef server_h +#define server_h + +#include "Print.h" + +class Server : public Print { +public: +  virtual void begin() =0; +}; + +#endif diff --git a/cores/xinput/Stream.cpp b/cores/xinput/Stream.cpp new file mode 100644 index 0000000..9eff663 --- /dev/null +++ b/cores/xinput/Stream.cpp @@ -0,0 +1,318 @@ +/* + Stream.cpp - adds parsing methods to Stream class + Copyright (c) 2008 David A. Mellis.  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 + + Created July 2011 + parsing functions based on TextFinder library by Michael Margolis + + findMulti/findUntil routines written by Jim Leonard/Xuth + */ + +#include "Arduino.h" +#include "Stream.h" + +#define PARSE_TIMEOUT 1000  // default number of milli-seconds to wait + +// protected method to read stream with timeout +int Stream::timedRead() +{ +  int c; +  _startMillis = millis(); +  do { +    c = read(); +    if (c >= 0) return c; +  } while(millis() - _startMillis < _timeout); +  return -1;     // -1 indicates timeout +} + +// protected method to peek stream with timeout +int Stream::timedPeek() +{ +  int c; +  _startMillis = millis(); +  do { +    c = peek(); +    if (c >= 0) return c; +  } while(millis() - _startMillis < _timeout); +  return -1;     // -1 indicates timeout +} + +// returns peek of the next digit in the stream or -1 if timeout +// discards non-numeric characters +int Stream::peekNextDigit(LookaheadMode lookahead, bool detectDecimal) +{ +  int c; +  while (1) { +    c = timedPeek(); + +    if( c < 0 || +        c == '-' || +        (c >= '0' && c <= '9') || +        (detectDecimal && c == '.')) return c; + +    switch( lookahead ){ +        case SKIP_NONE: return -1; // Fail code. +        case SKIP_WHITESPACE: +            switch( c ){ +                case ' ': +                case '\t': +                case '\r': +                case '\n': break; +                default: return -1; // Fail code. +            } +        case SKIP_ALL: +            break; +    } +    read();  // discard non-numeric +  } +} + +// Public Methods +////////////////////////////////////////////////////////////// + +void Stream::setTimeout(unsigned long timeout)  // sets the maximum number of milliseconds to wait +{ +  _timeout = timeout; +} + + // find returns true if the target string is found +bool  Stream::find(char *target) +{ +  return findUntil(target, strlen(target), NULL, 0); +} + +// reads data from the stream until the target string of given length is found +// returns true if target string is found, false if timed out +bool Stream::find(char *target, size_t length) +{ +  return findUntil(target, length, NULL, 0); +} + +// as find but search ends if the terminator string is found +bool  Stream::findUntil(char *target, char *terminator) +{ +  return findUntil(target, strlen(target), terminator, strlen(terminator)); +} + +// reads data from the stream until the target string of the given length is found +// search terminated if the terminator string is found +// returns true if target string is found, false if terminated or timed out +bool Stream::findUntil(char *target, size_t targetLen, char *terminator, size_t termLen) +{ +  if (terminator == NULL) { +    MultiTarget t[1] = {{target, targetLen, 0}}; +    return findMulti(t, 1) == 0 ? true : false; +  } else { +    MultiTarget t[2] = {{target, targetLen, 0}, {terminator, termLen, 0}}; +    return findMulti(t, 2) == 0 ? true : false; +  } +} + +// returns the first valid (long) integer value from the current position. +// lookahead determines how parseInt looks ahead in the stream. +// See LookaheadMode enumeration at the top of the file. +// Lookahead is terminated by the first character that is not a valid part of an integer. +// Once parsing commences, 'ignore' will be skipped in the stream. +long Stream::parseInt(LookaheadMode lookahead, char ignore) +{ +  bool isNegative = false; +  long value = 0; +  int c; + +  c = peekNextDigit(lookahead, false); +  // ignore non numeric leading characters +  if(c < 0) +    return 0; // zero returned if timeout + +  do{ +    if(c == ignore) +      ; // ignore this character +    else if(c == '-') +      isNegative = true; +    else if(c >= '0' && c <= '9')        // is c a digit? +      value = value * 10 + c - '0'; +    read();  // consume the character we got with peek +    c = timedPeek(); +  } +  while( (c >= '0' && c <= '9') || c == ignore ); + +  if(isNegative) +    value = -value; +  return value; +} + +// as parseInt but returns a floating point value +float Stream::parseFloat(LookaheadMode lookahead, char ignore) +{ +  bool isNegative = false; +  bool isFraction = false; +  long value = 0; +  int c; +  float fraction = 1.0; + +  c = peekNextDigit(lookahead, true); +    // ignore non numeric leading characters +  if(c < 0) +    return 0; // zero returned if timeout + +  do{ +    if(c == ignore) +      ; // ignore +    else if(c == '-') +      isNegative = true; +    else if (c == '.') +      isFraction = true; +    else if(c >= '0' && c <= '9')  {      // is c a digit? +      value = value * 10 + c - '0'; +      if(isFraction) +         fraction *= 0.1; +    } +    read();  // consume the character we got with peek +    c = timedPeek(); +  } +  while( (c >= '0' && c <= '9')  || (c == '.' && !isFraction) || c == ignore ); + +  if(isNegative) +    value = -value; +  if(isFraction) +    return value * fraction; +  else +    return value; +} + +// read characters from stream into buffer +// terminates if length characters have been read, or timeout (see setTimeout) +// returns the number of characters placed in the buffer +// the buffer is NOT null terminated. +// +size_t Stream::readBytes(char *buffer, size_t length) +{ +  size_t count = 0; +  while (count < length) { +    int c = timedRead(); +    if (c < 0) break; +    *buffer++ = (char)c; +    count++; +  } +  return count; +} + + +// as readBytes with terminator character +// terminates if length characters have been read, timeout, or if the terminator character  detected +// returns the number of characters placed in the buffer (0 means no valid data found) + +size_t Stream::readBytesUntil(char terminator, char *buffer, size_t length) +{ +  size_t index = 0; +  while (index < length) { +    int c = timedRead(); +    if (c < 0 || c == terminator) break; +    *buffer++ = (char)c; +    index++; +  } +  return index; // return number of characters, not including null terminator +} + +String Stream::readString() +{ +  String ret; +  int c = timedRead(); +  while (c >= 0) +  { +    ret += (char)c; +    c = timedRead(); +  } +  return ret; +} + +String Stream::readStringUntil(char terminator) +{ +  String ret; +  int c = timedRead(); +  while (c >= 0 && c != terminator) +  { +    ret += (char)c; +    c = timedRead(); +  } +  return ret; +} + +int Stream::findMulti( struct Stream::MultiTarget *targets, int tCount) { +  // any zero length target string automatically matches and would make +  // a mess of the rest of the algorithm. +  for (struct MultiTarget *t = targets; t < targets+tCount; ++t) { +    if (t->len <= 0) +      return t - targets; +  } + +  while (1) { +    int c = timedRead(); +    if (c < 0) +      return -1; + +    for (struct MultiTarget *t = targets; t < targets+tCount; ++t) { +      // the simple case is if we match, deal with that first. +      if (c == t->str[t->index]) { +        if (++t->index == t->len) +          return t - targets; +        else +          continue; +      } + +      // if not we need to walk back and see if we could have matched further +      // down the stream (ie '1112' doesn't match the first position in '11112' +      // but it will match the second position so we can't just reset the current +      // index to 0 when we find a mismatch. +      if (t->index == 0) +        continue; + +      int origIndex = t->index; +      do { +        --t->index; +        // first check if current char works against the new current index +        if (c != t->str[t->index]) +          continue; + +        // if it's the only char then we're good, nothing more to check +        if (t->index == 0) { +          t->index++; +          break; +        } + +        // otherwise we need to check the rest of the found string +        int diff = origIndex - t->index; +        size_t i; +        for (i = 0; i < t->index; ++i) { +          if (t->str[i] != t->str[i + diff]) +            break; +        } + +        // if we successfully got through the previous loop then our current +        // index is good. +        if (i == t->index) { +          t->index++; +          break; +        } + +        // otherwise we just try the next index +      } while (t->index); +    } +  } +  // unreachable +  return -1; +} diff --git a/cores/xinput/Stream.h b/cores/xinput/Stream.h new file mode 100644 index 0000000..21a247a --- /dev/null +++ b/cores/xinput/Stream.h @@ -0,0 +1,129 @@ +/* +  Stream.h - base class for character-based streams. +  Copyright (c) 2010 David A. Mellis.  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 + +  parsing functions based on TextFinder library by Michael Margolis +*/ + +#ifndef Stream_h +#define Stream_h + +#include <inttypes.h> +#include "Print.h" + +// compatibility macros for testing +/* +#define   getInt()            parseInt() +#define   getInt(ignore)    parseInt(ignore) +#define   getFloat()          parseFloat() +#define   getFloat(ignore)  parseFloat(ignore) +#define   getString( pre_string, post_string, buffer, length) +readBytesBetween( pre_string, terminator, buffer, length) +*/ + +// This enumeration provides the lookahead options for parseInt(), parseFloat() +// The rules set out here are used until either the first valid character is found +// or a time out occurs due to lack of input. +enum LookaheadMode{ +    SKIP_ALL,       // All invalid characters are ignored. +    SKIP_NONE,      // Nothing is skipped, and the stream is not touched unless the first waiting character is valid. +    SKIP_WHITESPACE // Only tabs, spaces, line feeds & carriage returns are skipped. +}; + +#define NO_IGNORE_CHAR  '\x01' // a char not found in a valid ASCII numeric field + +class Stream : public Print +{ +  protected: +    unsigned long _timeout;      // number of milliseconds to wait for the next char before aborting timed read +    unsigned long _startMillis;  // used for timeout measurement +    int timedRead();    // read stream with timeout +    int timedPeek();    // peek stream with timeout +    int peekNextDigit(LookaheadMode lookahead, bool detectDecimal); // returns the next numeric digit in the stream or -1 if timeout + +  public: +    virtual int available() = 0; +    virtual int read() = 0; +    virtual int peek() = 0; + +    Stream() {_timeout=1000;} + +// parsing methods + +  void setTimeout(unsigned long timeout);  // sets maximum milliseconds to wait for stream data, default is 1 second +  unsigned long getTimeout(void) { return _timeout; } +   +  bool find(char *target);   // reads data from the stream until the target string is found +  bool find(uint8_t *target) { return find ((char *)target); } +  // returns true if target string is found, false if timed out (see setTimeout) + +  bool find(char *target, size_t length);   // reads data from the stream until the target string of given length is found +  bool find(uint8_t *target, size_t length) { return find ((char *)target, length); } +  // returns true if target string is found, false if timed out + +  bool find(char target) { return find (&target, 1); } + +  bool findUntil(char *target, char *terminator);   // as find but search ends if the terminator string is found +  bool findUntil(uint8_t *target, char *terminator) { return findUntil((char *)target, terminator); } + +  bool findUntil(char *target, size_t targetLen, char *terminate, size_t termLen);   // as above but search ends if the terminate string is found +  bool findUntil(uint8_t *target, size_t targetLen, char *terminate, size_t termLen) {return findUntil((char *)target, targetLen, terminate, termLen); } + +  long parseInt(LookaheadMode lookahead = SKIP_ALL, char ignore = NO_IGNORE_CHAR); +  // returns the first valid (long) integer value from the current position. +  // lookahead determines how parseInt looks ahead in the stream. +  // See LookaheadMode enumeration at the top of the file. +  // Lookahead is terminated by the first character that is not a valid part of an integer. +  // Once parsing commences, 'ignore' will be skipped in the stream. + +  float parseFloat(LookaheadMode lookahead = SKIP_ALL, char ignore = NO_IGNORE_CHAR); +  // float version of parseInt + +  size_t readBytes( char *buffer, size_t length); // read chars from stream into buffer +  size_t readBytes( uint8_t *buffer, size_t length) { return readBytes((char *)buffer, length); } +  // terminates if length characters have been read or timeout (see setTimeout) +  // returns the number of characters placed in the buffer (0 means no valid data found) + +  size_t readBytesUntil( char terminator, char *buffer, size_t length); // as readBytes with terminator character +  size_t readBytesUntil( char terminator, uint8_t *buffer, size_t length) { return readBytesUntil(terminator, (char *)buffer, length); } +  // terminates if length characters have been read, timeout, or if the terminator character  detected +  // returns the number of characters placed in the buffer (0 means no valid data found) + +  // Arduino String functions to be added here +  String readString(); +  String readStringUntil(char terminator); + +  protected: +  long parseInt(char ignore) { return parseInt(SKIP_ALL, ignore); } +  float parseFloat(char ignore) { return parseFloat(SKIP_ALL, ignore); } +  // These overload exists for compatibility with any class that has derived +  // Stream and used parseFloat/Int with a custom ignore character. To keep +  // the public API simple, these overload remains protected. + +  struct MultiTarget { +    const char *str;  // string you're searching for +    size_t len;       // length of string you're searching for +    size_t index;     // index used by the search routine. +  }; + +  // This allows you to search for an arbitrary number of strings. +  // Returns index of the target that is found first or -1 if timeout occurs. +  int findMulti(struct MultiTarget *targets, int tCount); +}; + +#undef NO_IGNORE_CHAR +#endif diff --git a/cores/xinput/Tone.cpp b/cores/xinput/Tone.cpp new file mode 100644 index 0000000..1bfb3e3 --- /dev/null +++ b/cores/xinput/Tone.cpp @@ -0,0 +1,619 @@ +/* Tone.cpp + +  A Tone Generator Library + +  Written by Brett Hagman + +  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 + +Version Modified By Date     Comments +------- ----------- -------- -------- +0001    B Hagman    09/08/02 Initial coding +0002    B Hagman    09/08/18 Multiple pins +0003    B Hagman    09/08/18 Moved initialization from constructor to begin() +0004    B Hagman    09/09/26 Fixed problems with ATmega8 +0005    B Hagman    09/11/23 Scanned prescalars for best fit on 8 bit timers +                    09/11/25 Changed pin toggle method to XOR +                    09/11/25 Fixed timer0 from being excluded +0006    D Mellis    09/12/29 Replaced objects with functions +0007    M Sproul    10/08/29 Changed #ifdefs from cpu to register +0008    S Kanemoto  12/06/22 Fixed for Leonardo by @maris_HY +0009    J Reucker   15/04/10 Issue #292 Fixed problems with ATmega8 (thanks to Pete62) +0010    jipp        15/04/13 added additional define check #2923 +*************************************************/ + +#include <avr/interrupt.h> +#include <avr/pgmspace.h> +#include "Arduino.h" +#include "pins_arduino.h" + +#if defined(__AVR_ATmega8__) || defined(__AVR_ATmega128__) +#define TCCR2A TCCR2 +#define TCCR2B TCCR2 +#define COM2A1 COM21 +#define COM2A0 COM20 +#define OCR2A OCR2 +#define TIMSK2 TIMSK +#define OCIE2A OCIE2 +#define TIMER2_COMPA_vect TIMER2_COMP_vect +#define TIMSK1 TIMSK +#endif + +// timerx_toggle_count: +//  > 0 - duration specified +//  = 0 - stopped +//  < 0 - infinitely (until stop() method called, or new play() called) + +#if !defined(__AVR_ATmega8__) +volatile long timer0_toggle_count; +volatile uint8_t *timer0_pin_port; +volatile uint8_t timer0_pin_mask; +#endif + +volatile long timer1_toggle_count; +volatile uint8_t *timer1_pin_port; +volatile uint8_t timer1_pin_mask; +volatile long timer2_toggle_count; +volatile uint8_t *timer2_pin_port; +volatile uint8_t timer2_pin_mask; + +#if defined(TIMSK3) +volatile long timer3_toggle_count; +volatile uint8_t *timer3_pin_port; +volatile uint8_t timer3_pin_mask; +#endif + +#if defined(TIMSK4) +volatile long timer4_toggle_count; +volatile uint8_t *timer4_pin_port; +volatile uint8_t timer4_pin_mask; +#endif + +#if defined(TIMSK5) +volatile long timer5_toggle_count; +volatile uint8_t *timer5_pin_port; +volatile uint8_t timer5_pin_mask; +#endif + + +#if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__) + +#define AVAILABLE_TONE_PINS 1 +#define USE_TIMER2 + +const uint8_t PROGMEM tone_pin_to_timer_PGM[] = { 2 /*, 3, 4, 5, 1, 0 */ }; +static uint8_t tone_pins[AVAILABLE_TONE_PINS] = { 255 /*, 255, 255, 255, 255, 255 */ }; + +#elif defined(__AVR_ATmega8__) + +#define AVAILABLE_TONE_PINS 1 +#define USE_TIMER2 + +const uint8_t PROGMEM tone_pin_to_timer_PGM[] = { 2 /*, 1 */ }; +static uint8_t tone_pins[AVAILABLE_TONE_PINS] = { 255 /*, 255 */ }; + +#elif defined(__AVR_ATmega32U4__) +  +#define AVAILABLE_TONE_PINS 1 +#define USE_TIMER3 +  +const uint8_t PROGMEM tone_pin_to_timer_PGM[] = { 3 /*, 1 */ }; +static uint8_t tone_pins[AVAILABLE_TONE_PINS] = { 255 /*, 255 */ }; +  +#else + +#define AVAILABLE_TONE_PINS 1 +#define USE_TIMER2 + +// Leave timer 0 to last. +const uint8_t PROGMEM tone_pin_to_timer_PGM[] = { 2 /*, 1, 0 */ }; +static uint8_t tone_pins[AVAILABLE_TONE_PINS] = { 255 /*, 255, 255 */ }; + +#endif + + + +static int8_t toneBegin(uint8_t _pin) +{ +  int8_t _timer = -1; + +  // if we're already using the pin, the timer should be configured.   +  for (int i = 0; i < AVAILABLE_TONE_PINS; i++) { +    if (tone_pins[i] == _pin) { +      return pgm_read_byte(tone_pin_to_timer_PGM + i); +    } +  } +   +  // search for an unused timer. +  for (int i = 0; i < AVAILABLE_TONE_PINS; i++) { +    if (tone_pins[i] == 255) { +      tone_pins[i] = _pin; +      _timer = pgm_read_byte(tone_pin_to_timer_PGM + i); +      break; +    } +  } +   +  if (_timer != -1) +  { +    // Set timer specific stuff +    // All timers in CTC mode +    // 8 bit timers will require changing prescalar values, +    // whereas 16 bit timers are set to either ck/1 or ck/64 prescalar +    switch (_timer) +    { +      #if defined(TCCR0A) && defined(TCCR0B) && defined(WGM01) +      case 0: +        // 8 bit timer +        TCCR0A = 0; +        TCCR0B = 0; +        bitWrite(TCCR0A, WGM01, 1); +        bitWrite(TCCR0B, CS00, 1); +        timer0_pin_port = portOutputRegister(digitalPinToPort(_pin)); +        timer0_pin_mask = digitalPinToBitMask(_pin); +        break; +      #endif + +      #if defined(TCCR1A) && defined(TCCR1B) && defined(WGM12) +      case 1: +        // 16 bit timer +        TCCR1A = 0; +        TCCR1B = 0; +        bitWrite(TCCR1B, WGM12, 1); +        bitWrite(TCCR1B, CS10, 1); +        timer1_pin_port = portOutputRegister(digitalPinToPort(_pin)); +        timer1_pin_mask = digitalPinToBitMask(_pin); +        break; +      #endif + +      #if defined(TCCR2A) && defined(TCCR2B) +      case 2: +        // 8 bit timer +        TCCR2A = 0; +        TCCR2B = 0; +        bitWrite(TCCR2A, WGM21, 1); +        bitWrite(TCCR2B, CS20, 1); +        timer2_pin_port = portOutputRegister(digitalPinToPort(_pin)); +        timer2_pin_mask = digitalPinToBitMask(_pin); +        break; +      #endif + +      #if defined(TCCR3A) && defined(TCCR3B) &&  defined(TIMSK3) +      case 3: +        // 16 bit timer +        TCCR3A = 0; +        TCCR3B = 0; +        bitWrite(TCCR3B, WGM32, 1); +        bitWrite(TCCR3B, CS30, 1); +        timer3_pin_port = portOutputRegister(digitalPinToPort(_pin)); +        timer3_pin_mask = digitalPinToBitMask(_pin); +        break; +      #endif + +      #if defined(TCCR4A) && defined(TCCR4B) &&  defined(TIMSK4) +      case 4: +        // 16 bit timer +        TCCR4A = 0; +        TCCR4B = 0; +        #if defined(WGM42) +          bitWrite(TCCR4B, WGM42, 1); +        #elif defined(CS43) +          // TODO this may not be correct +          // atmega32u4 +          bitWrite(TCCR4B, CS43, 1); +        #endif +        bitWrite(TCCR4B, CS40, 1); +        timer4_pin_port = portOutputRegister(digitalPinToPort(_pin)); +        timer4_pin_mask = digitalPinToBitMask(_pin); +        break; +      #endif + +      #if defined(TCCR5A) && defined(TCCR5B) &&  defined(TIMSK5) +      case 5: +        // 16 bit timer +        TCCR5A = 0; +        TCCR5B = 0; +        bitWrite(TCCR5B, WGM52, 1); +        bitWrite(TCCR5B, CS50, 1); +        timer5_pin_port = portOutputRegister(digitalPinToPort(_pin)); +        timer5_pin_mask = digitalPinToBitMask(_pin); +        break; +      #endif +    } +  } + +  return _timer; +} + + + +// frequency (in hertz) and duration (in milliseconds). + +void tone(uint8_t _pin, unsigned int frequency, unsigned long duration) +{ +  uint8_t prescalarbits = 0b001; +  long toggle_count = 0; +  uint32_t ocr = 0; +  int8_t _timer; + +  _timer = toneBegin(_pin); + +  if (_timer >= 0) +  { +    // Set the pinMode as OUTPUT +    pinMode(_pin, OUTPUT); +     +    // if we are using an 8 bit timer, scan through prescalars to find the best fit +    if (_timer == 0 || _timer == 2) +    { +      ocr = F_CPU / frequency / 2 - 1; +      prescalarbits = 0b001;  // ck/1: same for both timers +      if (ocr > 255) +      { +        ocr = F_CPU / frequency / 2 / 8 - 1; +        prescalarbits = 0b010;  // ck/8: same for both timers + +        if (_timer == 2 && ocr > 255) +        { +          ocr = F_CPU / frequency / 2 / 32 - 1; +          prescalarbits = 0b011; +        } + +        if (ocr > 255) +        { +          ocr = F_CPU / frequency / 2 / 64 - 1; +          prescalarbits = _timer == 0 ? 0b011 : 0b100; + +          if (_timer == 2 && ocr > 255) +          { +            ocr = F_CPU / frequency / 2 / 128 - 1; +            prescalarbits = 0b101; +          } + +          if (ocr > 255) +          { +            ocr = F_CPU / frequency / 2 / 256 - 1; +            prescalarbits = _timer == 0 ? 0b100 : 0b110; +            if (ocr > 255) +            { +              // can't do any better than /1024 +              ocr = F_CPU / frequency / 2 / 1024 - 1; +              prescalarbits = _timer == 0 ? 0b101 : 0b111; +            } +          } +        } +      } + +#if defined(TCCR0B) +      if (_timer == 0) +      { +        TCCR0B = (TCCR0B & 0b11111000) | prescalarbits; +      } +      else +#endif +#if defined(TCCR2B) +      { +        TCCR2B = (TCCR2B & 0b11111000) | prescalarbits; +      } +#else +      { +        // dummy place holder to make the above ifdefs work +      } +#endif +    } +    else +    { +      // two choices for the 16 bit timers: ck/1 or ck/64 +      ocr = F_CPU / frequency / 2 - 1; + +      prescalarbits = 0b001; +      if (ocr > 0xffff) +      { +        ocr = F_CPU / frequency / 2 / 64 - 1; +        prescalarbits = 0b011; +      } + +      if (_timer == 1) +      { +#if defined(TCCR1B) +        TCCR1B = (TCCR1B & 0b11111000) | prescalarbits; +#endif +      } +#if defined(TCCR3B) +      else if (_timer == 3) +        TCCR3B = (TCCR3B & 0b11111000) | prescalarbits; +#endif +#if defined(TCCR4B) +      else if (_timer == 4) +        TCCR4B = (TCCR4B & 0b11111000) | prescalarbits; +#endif +#if defined(TCCR5B) +      else if (_timer == 5) +        TCCR5B = (TCCR5B & 0b11111000) | prescalarbits; +#endif + +    } +     + +    // Calculate the toggle count +    if (duration > 0) +    { +      toggle_count = 2 * frequency * duration / 1000; +    } +    else +    { +      toggle_count = -1; +    } + +    // Set the OCR for the given timer, +    // set the toggle count, +    // then turn on the interrupts +    switch (_timer) +    { + +#if defined(OCR0A) && defined(TIMSK0) && defined(OCIE0A) +      case 0: +        OCR0A = ocr; +        timer0_toggle_count = toggle_count; +        bitWrite(TIMSK0, OCIE0A, 1); +        break; +#endif + +      case 1: +#if defined(OCR1A) && defined(TIMSK1) && defined(OCIE1A) +        OCR1A = ocr; +        timer1_toggle_count = toggle_count; +        bitWrite(TIMSK1, OCIE1A, 1); +#elif defined(OCR1A) && defined(TIMSK) && defined(OCIE1A) +        // this combination is for at least the ATmega32 +        OCR1A = ocr; +        timer1_toggle_count = toggle_count; +        bitWrite(TIMSK, OCIE1A, 1); +#endif +        break; + +#if defined(OCR2A) && defined(TIMSK2) && defined(OCIE2A) +      case 2: +        OCR2A = ocr; +        timer2_toggle_count = toggle_count; +        bitWrite(TIMSK2, OCIE2A, 1); +        break; +#endif + +#if defined(OCR3A) && defined(TIMSK3) && defined(OCIE3A) +      case 3: +        OCR3A = ocr; +        timer3_toggle_count = toggle_count; +        bitWrite(TIMSK3, OCIE3A, 1); +        break; +#endif + +#if defined(OCR4A) && defined(TIMSK4) && defined(OCIE4A) +      case 4: +        OCR4A = ocr; +        timer4_toggle_count = toggle_count; +        bitWrite(TIMSK4, OCIE4A, 1); +        break; +#endif + +#if defined(OCR5A) && defined(TIMSK5) && defined(OCIE5A) +      case 5: +        OCR5A = ocr; +        timer5_toggle_count = toggle_count; +        bitWrite(TIMSK5, OCIE5A, 1); +        break; +#endif + +    } +  } +} + + +// XXX: this function only works properly for timer 2 (the only one we use +// currently).  for the others, it should end the tone, but won't restore +// proper PWM functionality for the timer. +void disableTimer(uint8_t _timer) +{ +  switch (_timer) +  { +    case 0: +      #if defined(TIMSK0) +        TIMSK0 = 0; +      #elif defined(TIMSK) +        TIMSK = 0; // atmega32 +      #endif +      break; + +#if defined(TIMSK1) && defined(OCIE1A) +    case 1: +      bitWrite(TIMSK1, OCIE1A, 0); +      break; +#endif + +    case 2: +      #if defined(TIMSK2) && defined(OCIE2A) +        bitWrite(TIMSK2, OCIE2A, 0); // disable interrupt +      #endif +      #if defined(TCCR2A) && defined(WGM20) +        TCCR2A = (1 << WGM20); +      #endif +      #if defined(TCCR2B) && defined(CS22) +        TCCR2B = (TCCR2B & 0b11111000) | (1 << CS22); +      #endif +      #if defined(OCR2A) +        OCR2A = 0; +      #endif +      break; + +#if defined(TIMSK3) && defined(OCIE3A) +    case 3: +      bitWrite(TIMSK3, OCIE3A, 0); +      break; +#endif + +#if defined(TIMSK4) && defined(OCIE4A) +    case 4: +      bitWrite(TIMSK4, OCIE4A, 0); +      break; +#endif + +#if defined(TIMSK5) && defined(OCIE5A) +    case 5: +      bitWrite(TIMSK5, OCIE5A, 0); +      break; +#endif +  } +} + + +void noTone(uint8_t _pin) +{ +  int8_t _timer = -1; +   +  for (int i = 0; i < AVAILABLE_TONE_PINS; i++) { +    if (tone_pins[i] == _pin) { +      _timer = pgm_read_byte(tone_pin_to_timer_PGM + i); +      tone_pins[i] = 255; +      break; +    } +  } +   +  disableTimer(_timer); + +  digitalWrite(_pin, 0); +} + +#ifdef USE_TIMER0 +ISR(TIMER0_COMPA_vect) +{ +  if (timer0_toggle_count != 0) +  { +    // toggle the pin +    *timer0_pin_port ^= timer0_pin_mask; + +    if (timer0_toggle_count > 0) +      timer0_toggle_count--; +  } +  else +  { +    disableTimer(0); +    *timer0_pin_port &= ~(timer0_pin_mask);  // keep pin low after stop +  } +} +#endif + + +#ifdef USE_TIMER1 +ISR(TIMER1_COMPA_vect) +{ +  if (timer1_toggle_count != 0) +  { +    // toggle the pin +    *timer1_pin_port ^= timer1_pin_mask; + +    if (timer1_toggle_count > 0) +      timer1_toggle_count--; +  } +  else +  { +    disableTimer(1); +    *timer1_pin_port &= ~(timer1_pin_mask);  // keep pin low after stop +  } +} +#endif + + +#ifdef USE_TIMER2 +ISR(TIMER2_COMPA_vect) +{ + +  if (timer2_toggle_count != 0) +  { +    // toggle the pin +    *timer2_pin_port ^= timer2_pin_mask; + +    if (timer2_toggle_count > 0) +      timer2_toggle_count--; +  } +  else +  { +    // need to call noTone() so that the tone_pins[] entry is reset, so the +    // timer gets initialized next time we call tone(). +    // XXX: this assumes timer 2 is always the first one used. +    noTone(tone_pins[0]); +//    disableTimer(2); +//    *timer2_pin_port &= ~(timer2_pin_mask);  // keep pin low after stop +  } +} +#endif + + +#ifdef USE_TIMER3 +ISR(TIMER3_COMPA_vect) +{ +  if (timer3_toggle_count != 0) +  { +    // toggle the pin +    *timer3_pin_port ^= timer3_pin_mask; + +    if (timer3_toggle_count > 0) +      timer3_toggle_count--; +  } +  else +  { +    disableTimer(3); +    *timer3_pin_port &= ~(timer3_pin_mask);  // keep pin low after stop +  } +} +#endif + + +#ifdef USE_TIMER4 +ISR(TIMER4_COMPA_vect) +{ +  if (timer4_toggle_count != 0) +  { +    // toggle the pin +    *timer4_pin_port ^= timer4_pin_mask; + +    if (timer4_toggle_count > 0) +      timer4_toggle_count--; +  } +  else +  { +    disableTimer(4); +    *timer4_pin_port &= ~(timer4_pin_mask);  // keep pin low after stop +  } +} +#endif + + +#ifdef USE_TIMER5 +ISR(TIMER5_COMPA_vect) +{ +  if (timer5_toggle_count != 0) +  { +    // toggle the pin +    *timer5_pin_port ^= timer5_pin_mask; + +    if (timer5_toggle_count > 0) +      timer5_toggle_count--; +  } +  else +  { +    disableTimer(5); +    *timer5_pin_port &= ~(timer5_pin_mask);  // keep pin low after stop +  } +} +#endif diff --git a/cores/xinput/USBAPI.h b/cores/xinput/USBAPI.h new file mode 100644 index 0000000..1ad268c --- /dev/null +++ b/cores/xinput/USBAPI.h @@ -0,0 +1,189 @@ +/* +  USBAPI.h +  Copyright (c) 2005-2014 Arduino.  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 +*/ + +#ifndef __USBAPI__ +#define __USBAPI__ + +#include <inttypes.h> +#include <avr/pgmspace.h> +#include <avr/eeprom.h> +#include <avr/interrupt.h> +#include <util/delay.h> + +typedef unsigned char u8; +typedef unsigned short u16; +typedef unsigned long u32; + +#include "Arduino.h" + +// This definitions is useful if you want to reduce the EP_SIZE to 16 +// at the moment only 64 and 16 as EP_SIZE for all EPs are supported except the control endpoint +#ifndef USB_EP_SIZE +#define USB_EP_SIZE 64 +#endif + +#if defined(USBCON) + +#include "USBDesc.h" +#include "USBCore.h" +#include "xinput/USB_XInput_Descriptors.h" + +//================================================================================ +//================================================================================ +//	USB + +#define EP_TYPE_CONTROL				(0x00) +#define EP_TYPE_BULK_IN				((1<<EPTYPE1) | (1<<EPDIR)) +#define EP_TYPE_BULK_OUT			(1<<EPTYPE1) +#define EP_TYPE_INTERRUPT_IN		((1<<EPTYPE1) | (1<<EPTYPE0) | (1<<EPDIR)) +#define EP_TYPE_INTERRUPT_OUT		((1<<EPTYPE1) | (1<<EPTYPE0)) +#define EP_TYPE_ISOCHRONOUS_IN		((1<<EPTYPE0) | (1<<EPDIR)) +#define EP_TYPE_ISOCHRONOUS_OUT		(1<<EPTYPE0) + +class USBDevice_ +{ +public: +	USBDevice_(); +	bool configured(); + +	void attach(); +	void detach();	// Serial port goes down too... +	void poll(); +	bool wakeupHost(); // returns false, when wakeup cannot be processed + +	bool isSuspended(); +}; +extern USBDevice_ USBDevice; + +//================================================================================ +//================================================================================ +//	Serial over CDC (Serial1 is the physical port) + +struct ring_buffer; + +#ifndef SERIAL_BUFFER_SIZE +#if ((RAMEND - RAMSTART) < 1023) +#define SERIAL_BUFFER_SIZE 16 +#else +#define SERIAL_BUFFER_SIZE 64 +#endif +#endif +#if (SERIAL_BUFFER_SIZE>256) +#error Please lower the CDC Buffer size +#endif + +class Serial_ : public Stream +{ +public: +	Serial_() {}; +	void begin(unsigned long) {} +	void begin(unsigned long, uint8_t) {} +	void end(void) {} + +	virtual int available(void) { return -1; } +	virtual int peek(void) { return -1; } +	virtual int read(void) { return -1; } +	virtual int availableForWrite(void) { return 0; } +	virtual void flush(void) {} +	virtual size_t write(uint8_t) { return 1; } +	virtual size_t write(const uint8_t*, size_t n) { return n; } +	using Print::write; // pull in write(str) and write(buf, size) from Print +	operator bool() { return true; } + +	// This method allows processing "SEND_BREAK" requests sent by +	// the USB host. Those requests indicate that the host wants to +	// send a BREAK signal and are accompanied by a single uint16_t +	// value, specifying the duration of the break. The value 0 +	// means to end any current break, while the value 0xffff means +	// to start an indefinite break. +	// readBreak() will return the value of the most recent break +	// request, but will return it at most once, returning -1 when +	// readBreak() is called again (until another break request is +	// received, which is again returned once). +	// This also mean that if two break requests are received +	// without readBreak() being called in between, the value of the +	// first request is lost. +	// Note that the value returned is a long, so it can return +	// 0-0xffff as well as -1. +	int32_t readBreak() { return -1; }; + +	// These return the settings specified by the USB host for the +	// serial port. These aren't really used, but are offered here +	// in case a sketch wants to act on these settings. +	uint32_t baud() { return 0; } +	uint8_t stopbits() { return 1; } +	uint8_t paritytype() { return 0; } +	uint8_t numbits() { return 8; } +	bool dtr() { return true; } +	bool rts() { return true; } +	enum { +		ONE_STOP_BIT = 0, +		ONE_AND_HALF_STOP_BIT = 1, +		TWO_STOP_BITS = 2, +	}; +	enum { +		NO_PARITY = 0, +		ODD_PARITY = 1, +		EVEN_PARITY = 2, +		MARK_PARITY = 3, +		SPACE_PARITY = 4, +	}; + +}; +extern Serial_ Serial; + +#define HAVE_CDCSERIAL + +//================================================================================ +//================================================================================ +//  Low level API + +typedef struct +{ +	uint8_t bmRequestType; +	uint8_t bRequest; +	uint8_t wValueL; +	uint8_t wValueH; +	uint16_t wIndex; +	uint16_t wLength; +} USBSetup; + +//================================================================================ +//================================================================================ + +#define TRANSFER_PGM		0x80 +#define TRANSFER_RELEASE	0x40 +#define TRANSFER_ZERO		0x20 + +int USB_SendControl(uint8_t flags, const void* d, int len); +int USB_RecvControl(void* d, int len); +int USB_RecvControlLong(void* d, int len); + +uint8_t	USB_Available(uint8_t ep); +uint8_t USB_SendSpace(uint8_t ep); +int USB_Send(uint8_t ep, const void* data, int len);	// blocking +int USB_Recv(uint8_t ep, void* data, int len);		// non-blocking +int USB_Recv(uint8_t ep);							// non-blocking +void USB_Flush(uint8_t ep); + +#include "xinput/USB_XInput_API.h" + +#endif + +#endif /* if defined(USBCON) */ diff --git a/cores/xinput/USBCore.cpp b/cores/xinput/USBCore.cpp new file mode 100644 index 0000000..b384984 --- /dev/null +++ b/cores/xinput/USBCore.cpp @@ -0,0 +1,834 @@ + + +/* Copyright (c) 2010, Peter Barrett +** Sleep/Wakeup support added by Michael Dreher +**   +** Permission to use, copy, modify, and/or distribute this software for   +** any purpose with or without fee is hereby granted, provided that the   +** above copyright notice and this permission notice appear in all copies.   +**  +** THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL   +** WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED   +** WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR   +** BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES   +** OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,   +** WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,   +** ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS   +** SOFTWARE.   +*/ + +#include "USBAPI.h" +#include "PluggableUSB.h" +#include <stdlib.h> + +#if defined(USBCON) + +/** Pulse generation counters to keep track of the number of milliseconds remaining for each pulse type */ +#define TX_RX_LED_PULSE_MS 100 +volatile u8 TxLEDPulse; /**< Milliseconds remaining for data Tx LED pulse */ +volatile u8 RxLEDPulse; /**< Milliseconds remaining for data Rx LED pulse */ + +//================================================================== +//================================================================== + +extern const u16 STRING_LANGUAGE[] PROGMEM; +extern const u8 STRING_PRODUCT[] PROGMEM; +extern const u8 STRING_MANUFACTURER[] PROGMEM; + +const u16 STRING_LANGUAGE[2] = { +	(3<<8) | (2+2), +	0x0409	// English +}; + +#ifndef USB_PRODUCT +// If no product is provided, use USB IO Board +#define USB_PRODUCT     "USB IO Board" +#endif + +const u8 STRING_PRODUCT[] PROGMEM = USB_PRODUCT; + +#if USB_VID == 0x2341 +#  if defined(USB_MANUFACTURER) +#    undef USB_MANUFACTURER +#  endif +#  define USB_MANUFACTURER "Arduino LLC" +#elif USB_VID == 0x1b4f +#  if defined(USB_MANUFACTURER) +#    undef USB_MANUFACTURER +#  endif +#  define USB_MANUFACTURER "SparkFun" +#elif !defined(USB_MANUFACTURER) +// Fall through to unknown if no manufacturer name was provided in a macro +#  define USB_MANUFACTURER "Unknown" +#endif + +const u8 STRING_MANUFACTURER[] PROGMEM = USB_MANUFACTURER; + +//================================================================== +//================================================================== + +volatile u8 _usbConfiguration = 0; +volatile u8 _usbCurrentStatus = 0; // meaning of bits see usb_20.pdf, Figure 9-4. Information Returned by a GetStatus() Request to a Device +volatile u8 _usbSuspendState = 0; // copy of UDINT to check SUSPI and WAKEUPI bits + +static inline void WaitIN(void) +{ +	while (!(UEINTX & (1<<TXINI))) +		; +} + +static inline void ClearIN(void) +{ +	UEINTX = ~(1<<TXINI); +} + +static inline void WaitOUT(void) +{ +	while (!(UEINTX & (1<<RXOUTI))) +		; +} + +static inline u8 WaitForINOrOUT() +{ +	while (!(UEINTX & ((1<<TXINI)|(1<<RXOUTI)))) +		; +	return (UEINTX & (1<<RXOUTI)) == 0; +} + +static inline void ClearOUT(void) +{ +	UEINTX = ~(1<<RXOUTI); +} + +static inline void Recv(volatile u8* data, u8 count) +{ +	while (count--) +		*data++ = UEDATX; +	 +	RXLED1;					// light the RX LED +	RxLEDPulse = TX_RX_LED_PULSE_MS;	 +} + +static inline u8 Recv8() +{ +	RXLED1;					// light the RX LED +	RxLEDPulse = TX_RX_LED_PULSE_MS; + +	return UEDATX;	 +} + +static inline void Send8(u8 d) +{ +	UEDATX = d; +} + +static inline void SetEP(u8 ep) +{ +	UENUM = ep; +} + +static inline u8 FifoByteCount() +{ +	return UEBCLX; +} + +static inline u8 ReceivedSetupInt() +{ +	return UEINTX & (1<<RXSTPI); +} + +static inline void ClearSetupInt() +{ +	UEINTX = ~((1<<RXSTPI) | (1<<RXOUTI) | (1<<TXINI)); +} + +static inline void Stall() +{ +	UECONX = (1<<STALLRQ) | (1<<EPEN); +} + +static inline u8 ReadWriteAllowed() +{ +	return UEINTX & (1<<RWAL); +} + +static inline u8 Stalled() +{ +	return UEINTX & (1<<STALLEDI); +} + +static inline u8 FifoFree() +{ +	return UEINTX & (1<<FIFOCON); +} + +static inline void ReleaseRX() +{ +	UEINTX = 0x6B;	// FIFOCON=0 NAKINI=1 RWAL=1 NAKOUTI=0 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=1 +} + +static inline void ReleaseTX() +{ +	UEINTX = 0x3A;	// FIFOCON=0 NAKINI=0 RWAL=1 NAKOUTI=1 RXSTPI=1 RXOUTI=0 STALLEDI=1 TXINI=0 +} + +static inline u8 FrameNumber() +{ +	return UDFNUML; +} + +//================================================================== +//================================================================== + +u8 USBGetConfiguration(void) +{ +	return _usbConfiguration; +} + +#define USB_RECV_TIMEOUT +class LockEP +{ +	u8 _sreg; +public: +	LockEP(u8 ep) : _sreg(SREG) +	{ +		cli(); +		SetEP(ep & 7); +	} +	~LockEP() +	{ +		SREG = _sreg; +	} +}; + +//	Number of bytes, assumes a rx endpoint +u8 USB_Available(u8 ep) +{ +	LockEP lock(ep); +	return FifoByteCount(); +} + +//	Non Blocking receive +//	Return number of bytes read +int USB_Recv(u8 ep, void* d, int len) +{ +	if (!_usbConfiguration || len < 0) +		return -1; +	 +	LockEP lock(ep); +	u8 n = FifoByteCount(); +	len = min(n,len); +	n = len; +	u8* dst = (u8*)d; +	while (n--) +		*dst++ = Recv8(); +	if (len && !FifoByteCount())	// release empty buffer +		ReleaseRX(); +	 +	return len; +} + +//	Recv 1 byte if ready +int USB_Recv(u8 ep) +{ +	u8 c; +	if (USB_Recv(ep,&c,1) != 1) +		return -1; +	return c; +} + +//	Space in send EP +u8 USB_SendSpace(u8 ep) +{ +	LockEP lock(ep); +	if (!ReadWriteAllowed()) +		return 0; +	return USB_EP_SIZE - FifoByteCount(); +} + +//	Blocking Send of data to an endpoint +int USB_Send(u8 ep, const void* d, int len) +{ +	if (!_usbConfiguration) +		return -1; + +	if (_usbSuspendState & (1<<SUSPI)) { +		//send a remote wakeup +		UDCON |= (1 << RMWKUP); +	} + +	int r = len; +	const u8* data = (const u8*)d; +	u8 timeout = 250;		// 250ms timeout on send? TODO +	bool sendZlp = false; + +	while (len || sendZlp) +	{ +		u8 n = USB_SendSpace(ep); +		if (n == 0) +		{ +			if (!(--timeout)) +				return -1; +			delay(1); +			continue; +		} + +		if (n > len) { +			n = len; +		} + +		{ +			LockEP lock(ep); +			// Frame may have been released by the SOF interrupt handler +			if (!ReadWriteAllowed()) +				continue; + +			len -= n; +			if (ep & TRANSFER_ZERO) +			{ +				while (n--) +					Send8(0); +			} +			else if (ep & TRANSFER_PGM) +			{ +				while (n--) +					Send8(pgm_read_byte(data++)); +			} +			else +			{ +				while (n--) +					Send8(*data++); +			} + +			if (sendZlp) { +				ReleaseTX(); +				sendZlp = false; +			} else if (!ReadWriteAllowed()) { // ...release if buffer is full... +				ReleaseTX(); +				if (len == 0) sendZlp = true; +			} else if ((len == 0) && (ep & TRANSFER_RELEASE)) { // ...or if forced with TRANSFER_RELEASE +				// XXX: TRANSFER_RELEASE is never used can be removed? +				ReleaseTX(); +			} +		} +	} +	TXLED1;					// light the TX LED +	TxLEDPulse = TX_RX_LED_PULSE_MS; +	return r; +} + +#define EP_SINGLE_64 0x32	// EP0 +#define EP_DOUBLE_64 0x36	// Other endpoints +#define EP_SINGLE_16 0x12 + +static inline +u8 BankSizeMask(const uint8_t nbytes) +{ +	uint8_t mask = 0; +	for (uint8_t size = 8; size < 64; size <<= 1) { +		if (nbytes <= size) break; +		mask++; +	} + +	return (mask << EPSIZE0); +} + +static inline +void InitEP(u8 index, u8 type, u8 size) +{ +	UENUM = index;       // Select endpoint +	UECONX = (1<<EPEN);  // Enable endpoint +	UECFG0X = type;      // Direction and transmission type +	UECFG1X = size;      // Memory allocation, # of data banks, and bank size +} + +static inline +bool InitEPSize(const u8 index, const u8 type, const u8 nbanks, const u8 banksize) +{ +	if (index >= USB_ENDPOINTS) return false; +	uint8_t size = ((1 << ALLOC) | ((nbanks > 1) ? (1 << EPBK0) : 0) | BankSizeMask(banksize)); +	InitEP(index, type, size); +	return UESTA0X & (1 << CFGOK);  // Success +} + +static +void InitEndpoints() +{ +	InitEPSize(XINPUT_TX_ENDPOINT, EP_TYPE_INTERRUPT_IN,  1, 32);  // Control Data Send +	InitEPSize(XINPUT_RX_ENDPOINT, EP_TYPE_INTERRUPT_OUT, 2, 32);  // Control Data Receive +	InitEPSize(5, EP_TYPE_INTERRUPT_IN,  1, 32);  // Expansion Interface NACK (avoid config reset) + +	UERST = 0x7E;  // Reset endpoints +	UERST = 0;     // End reset + +	SetEP(XINPUT_RX_ENDPOINT);  // Select XInput RX endpoint (OUT) +	UEIENX |= (1 << RXOUTE);  // Enable received "OUT" interrupt +} + +static int _cmark; +static int _cend; +void InitControl(int end) +{ +	SetEP(0); +	_cmark = 0; +	_cend = end; +} + +static +bool SendControl(u8 d) +{ +	if (_cmark < _cend) +	{ +		if (!WaitForINOrOUT()) +			return false; +		Send8(d); +		if (!((_cmark + 1) & 0x3F)) +			ClearIN();	// Fifo is full, release this packet +	} +	_cmark++; +	return true; +} + +//	Clipped by _cmark/_cend +int USB_SendControl(u8 flags, const void* d, int len) +{ +	int sent = len; +	const u8* data = (const u8*)d; +	bool pgm = flags & TRANSFER_PGM; +	while (len--) +	{ +		u8 c = pgm ? pgm_read_byte(data++) : *data++; +		if (!SendControl(c)) +			return -1; +	} +	return sent; +} + +// Send a USB descriptor string. The string is stored in PROGMEM as a +// plain ASCII string but is sent out as UTF-16 with the correct 2-byte +// prefix +static bool USB_SendStringDescriptor(const u8*string_P, u8 string_len, uint8_t flags) { +        SendControl(2 + string_len * 2); +        SendControl(3); +        bool pgm = flags & TRANSFER_PGM; +        for(u8 i = 0; i < string_len; i++) { +                bool r = SendControl(pgm ? pgm_read_byte(&string_P[i]) : string_P[i]); +                r &= SendControl(0); // high byte +                if(!r) { +                        return false; +                } +        } +        return true; +} + +//	Does not timeout or cross fifo boundaries +int USB_RecvControl(void* d, int len) +{ +	auto length = len; +	while(length) +	{ +		// Dont receive more than the USB Control EP has to offer +		// Use fixed 64 because control EP always have 64 bytes even on 16u2. +		auto recvLength = length; +		if(recvLength > 64){ +			recvLength = 64; +		} + +		// Write data to fit to the end (not the beginning) of the array +		WaitOUT(); +		Recv((u8*)d + len - length, recvLength); +		ClearOUT(); +		length -= recvLength; +	} +	return len; +} + +//	Construct a dynamic configuration descriptor +//	This really needs dynamic endpoint allocation etc +//	TODO +static +bool SendConfiguration(int maxlen) +{ +	InitControl(maxlen); +	USB_SendControl(TRANSFER_PGM, &USB_ConfigDescriptor, USB_ConfigDescriptorSize); +	return true; +} + +static +bool SendDescriptor(USBSetup& setup) +{ +	u8 t = setup.wValueH; +	if (USB_CONFIGURATION_DESCRIPTOR_TYPE == t) +		return SendConfiguration(setup.wLength); + +	InitControl(setup.wLength); +#ifdef PLUGGABLE_USB_ENABLED +	int ret = PluggableUSB().getDescriptor(setup); +	if (ret != 0) { +		return (ret > 0 ? true : false); +	} +#endif + +	const u8* desc_addr = 0; +	if (USB_DEVICE_DESCRIPTOR_TYPE == t) +	{ +		desc_addr = (const u8*) &USB_DeviceDescriptor; +	} +	else if (USB_STRING_DESCRIPTOR_TYPE == t) +	{ +		if (setup.wValueL == 0) { +			desc_addr = (const u8*)&STRING_LANGUAGE; +		} +		else if (setup.wValueL == IPRODUCT) { +			return USB_SendStringDescriptor(STRING_PRODUCT, strlen(USB_PRODUCT), TRANSFER_PGM); +		} +		else if (setup.wValueL == IMANUFACTURER) { +			return USB_SendStringDescriptor(STRING_MANUFACTURER, strlen(USB_MANUFACTURER), TRANSFER_PGM); +		} +		else if (setup.wValueL == ISERIAL) { +#ifdef PLUGGABLE_USB_ENABLED +			char name[ISERIAL_MAX_LEN]; +			PluggableUSB().getShortName(name); +			return USB_SendStringDescriptor((uint8_t*)name, strlen(name), 0); +#else +			return USB_SendStringDescriptor(STRING_SERIAL, strlen((char*)STRING_SERIAL), TRANSFER_PGM); +#endif +		} +		else if (setup.wValueL == ISECURITY) { +			return USB_SendStringDescriptor(STRING_SECURITY, strlen((char*)STRING_SECURITY), TRANSFER_PGM); +		} +		else +			return false; +	} + +	if (desc_addr == 0) +		return false; +	u8 desc_length = pgm_read_byte(desc_addr); + +	USB_SendControl(TRANSFER_PGM,desc_addr,desc_length); +	return true; +} + +//	Endpoint interrupt +ISR(USB_COM_vect) +{ +	SetEP(XINPUT_RX_ENDPOINT);  // Select XInput RX endpoint (OUT) +	if (UEINTX & (1 << RXOUTI)) {  // If data received... +		UEINTX &= ~(1 << RXOUTI);  // Clear interrupt flag +		if (XInputUSB::RecvCallback != nullptr) { +			XInputUSB::RecvCallback();  // Call callback function if it exists +		} +	} + +    SetEP(0); +	if (!ReceivedSetupInt()) +		return; + +	USBSetup setup; +	Recv((u8*)&setup,8); +	ClearSetupInt(); + +	u8 requestType = setup.bmRequestType; +	if (requestType & REQUEST_DEVICETOHOST) +		WaitIN(); +	else +		ClearIN(); + +    bool ok = true; +	if (REQUEST_STANDARD == (requestType & REQUEST_TYPE)) +	{ +		//	Standard Requests +		u8 r = setup.bRequest; +		u16 wValue = setup.wValueL | (setup.wValueH << 8); +		if (GET_STATUS == r) +		{ +			if (requestType == (REQUEST_DEVICETOHOST | REQUEST_STANDARD | REQUEST_DEVICE)) +			{ +				Send8(_usbCurrentStatus); +				Send8(0); +			} +			else +			{ +				// TODO: handle the HALT state of an endpoint here +				// see "Figure 9-6. Information Returned by a GetStatus() Request to an Endpoint" in usb_20.pdf for more information +				Send8(0); +				Send8(0); +			} +		} +		else if (CLEAR_FEATURE == r) +		{ +			if((requestType == (REQUEST_HOSTTODEVICE | REQUEST_STANDARD | REQUEST_DEVICE)) +				&& (wValue == DEVICE_REMOTE_WAKEUP)) +			{ +				_usbCurrentStatus &= ~FEATURE_REMOTE_WAKEUP_ENABLED; +			} +		} +		else if (SET_FEATURE == r) +		{ +			if((requestType == (REQUEST_HOSTTODEVICE | REQUEST_STANDARD | REQUEST_DEVICE)) +				&& (wValue == DEVICE_REMOTE_WAKEUP)) +			{ +				_usbCurrentStatus |= FEATURE_REMOTE_WAKEUP_ENABLED; +			} +		} +		else if (SET_ADDRESS == r) +		{ +			WaitIN(); +			UDADDR = setup.wValueL | (1<<ADDEN); +		} +		else if (GET_DESCRIPTOR == r) +		{ +			ok = SendDescriptor(setup); +		} +		else if (SET_DESCRIPTOR == r) +		{ +			ok = false; +		} +		else if (GET_CONFIGURATION == r) +		{ +			Send8(1); +		} +		else if (SET_CONFIGURATION == r) +		{ +			if (REQUEST_DEVICE == (requestType & REQUEST_RECIPIENT)) +			{ +				InitEndpoints(); +				_usbConfiguration = setup.wValueL; +			} else +				ok = false; +		} +		else if (GET_INTERFACE == r) +		{ +		} +		else if (SET_INTERFACE == r) +		{ +		} +	} +	else +	{ +		ok = true; +	} + +	if (ok) +		ClearIN(); +	else +	{ +		Stall(); +	} +} + +void USB_Flush(u8 ep) +{ +	SetEP(ep); +	if (FifoByteCount()) +		ReleaseTX(); +} + +static inline void USB_ClockDisable() +{ +#if defined(OTGPADE) +	USBCON = (USBCON & ~(1<<OTGPADE)) | (1<<FRZCLK); // freeze clock and disable VBUS Pad +#else // u2 Series +	USBCON = (1 << FRZCLK); // freeze clock +#endif +	PLLCSR &= ~(1<<PLLE);  // stop PLL +} + +static inline void USB_ClockEnable() +{ +#if defined(UHWCON) +	UHWCON |= (1<<UVREGE);			// power internal reg +#endif +	USBCON = (1<<USBE) | (1<<FRZCLK);	// clock frozen, usb enabled + +// ATmega32U4 +#if defined(PINDIV) +#if F_CPU == 16000000UL +	PLLCSR |= (1<<PINDIV);                   // Need 16 MHz xtal +#elif F_CPU == 8000000UL +	PLLCSR &= ~(1<<PINDIV);                  // Need  8 MHz xtal +#else +#error "Clock rate of F_CPU not supported" +#endif + +#elif defined(__AVR_AT90USB82__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega8U2__) +	// for the u2 Series the datasheet is confusing. On page 40 its called PINDIV and on page 290 its called PLLP0 +#if F_CPU == 16000000UL +	// Need 16 MHz xtal +	PLLCSR |= (1 << PLLP0); +#elif F_CPU == 8000000UL +	// Need 8 MHz xtal +	PLLCSR &= ~(1 << PLLP0); +#endif + +// AT90USB646, AT90USB647, AT90USB1286, AT90USB1287 +#elif defined(PLLP2) +#if F_CPU == 16000000UL +#if defined(__AVR_AT90USB1286__) || defined(__AVR_AT90USB1287__) +	// For Atmel AT90USB128x only. Do not use with Atmel AT90USB64x. +	PLLCSR = (PLLCSR & ~(1<<PLLP1)) | ((1<<PLLP2) | (1<<PLLP0)); // Need 16 MHz xtal +#elif defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB647__) +	// For AT90USB64x only. Do not use with AT90USB128x. +	PLLCSR = (PLLCSR & ~(1<<PLLP0)) | ((1<<PLLP2) | (1<<PLLP1)); // Need 16 MHz xtal +#else +#error "USB Chip not supported, please defined method of USB PLL initialization" +#endif +#elif F_CPU == 8000000UL +	// for Atmel AT90USB128x and AT90USB64x +	PLLCSR = (PLLCSR & ~(1<<PLLP2)) | ((1<<PLLP1) | (1<<PLLP0)); // Need 8 MHz xtal +#else +#error "Clock rate of F_CPU not supported" +#endif +#else +#error "USB Chip not supported, please defined method of USB PLL initialization" +#endif + +	PLLCSR |= (1<<PLLE); +	while (!(PLLCSR & (1<<PLOCK)))		// wait for lock pll +	{ +	} + +	// Some tests on specific versions of macosx (10.7.3), reported some +	// strange behaviors when the board is reset using the serial +	// port touch at 1200 bps. This delay fixes this behavior. +	delay(1); +#if defined(OTGPADE) +	USBCON = (USBCON & ~(1<<FRZCLK)) | (1<<OTGPADE);	// start USB clock, enable VBUS Pad +#else +	USBCON &= ~(1 << FRZCLK);	// start USB clock +#endif + +#if defined(RSTCPU) +#if defined(LSM) +	UDCON &= ~((1<<RSTCPU) | (1<<LSM) | (1<<RMWKUP) | (1<<DETACH));	// enable attach resistor, set full speed mode +#else // u2 Series +	UDCON &= ~((1 << RSTCPU) | (1 << RMWKUP) | (1 << DETACH));	// enable attach resistor, set full speed mode +#endif +#else +	// AT90USB64x and AT90USB128x don't have RSTCPU +	UDCON &= ~((1<<LSM) | (1<<RMWKUP) | (1<<DETACH));	// enable attach resistor, set full speed mode +#endif +} + +//	General interrupt +ISR(USB_GEN_vect) +{ +	u8 udint = UDINT; +	UDINT &= ~((1<<EORSTI) | (1<<SOFI)); // clear the IRQ flags for the IRQs which are handled here, except WAKEUPI and SUSPI (see below) + +	//	End of Reset +	if (udint & (1<<EORSTI)) +	{ +		InitEP(0,EP_TYPE_CONTROL,EP_SINGLE_64);	// init ep0 +		_usbConfiguration = 0;			// not configured yet +		UEIENX = 1 << RXSTPE;			// Enable interrupts for ep0 +	} + +	//	Start of Frame - happens every millisecond so we use it for TX and RX LED one-shot timing, too +	if (udint & (1<<SOFI)) +	{ +		// check whether the one-shot period has elapsed.  if so, turn off the LED +		if (TxLEDPulse && !(--TxLEDPulse)) +			TXLED0; +		if (RxLEDPulse && !(--RxLEDPulse)) +			RXLED0; +	} + +	// the WAKEUPI interrupt is triggered as soon as there are non-idle patterns on the data +	// lines. Thus, the WAKEUPI interrupt can occur even if the controller is not in the "suspend" mode. +	// Therefore the we enable it only when USB is suspended +	if (udint & (1<<WAKEUPI)) +	{ +		UDIEN = (UDIEN & ~(1<<WAKEUPE)) | (1<<SUSPE); // Disable interrupts for WAKEUP and enable interrupts for SUSPEND + +		//TODO +		// WAKEUPI shall be cleared by software (USB clock inputs must be enabled before). +		//USB_ClockEnable(); +		UDINT &= ~(1<<WAKEUPI); +		_usbSuspendState = (_usbSuspendState & ~(1<<SUSPI)) | (1<<WAKEUPI); +	} +	else if (udint & (1<<SUSPI)) // only one of the WAKEUPI / SUSPI bits can be active at time +	{ +		UDIEN = (UDIEN & ~(1<<SUSPE)) | (1<<WAKEUPE); // Disable interrupts for SUSPEND and enable interrupts for WAKEUP + +		//TODO +		//USB_ClockDisable(); + +		UDINT &= ~((1<<WAKEUPI) | (1<<SUSPI)); // clear any already pending WAKEUP IRQs and the SUSPI request +		_usbSuspendState = (_usbSuspendState & ~(1<<WAKEUPI)) | (1<<SUSPI); +	} +} + +//	VBUS or counting frames +//	Any frame counting? +u8 USBConnected() +{ +	u8 f = UDFNUML; +	delay(3); +	return f != UDFNUML; +} + +//======================================================================= +//======================================================================= + +USBDevice_ USBDevice; + +USBDevice_::USBDevice_() +{ +} + +void USBDevice_::attach() +{ +	_usbConfiguration = 0; +	_usbCurrentStatus = 0; +	_usbSuspendState = 0; +	USB_ClockEnable(); + +	UDINT &= ~((1<<WAKEUPI) | (1<<SUSPI)); // clear already pending WAKEUP / SUSPEND requests +	UDIEN = (1<<EORSTE) | (1<<SOFE) | (1<<SUSPE);	// Enable interrupts for EOR (End of Reset), SOF (start of frame) and SUSPEND +	 +	TX_RX_LED_INIT; +} + +void USBDevice_::detach() +{ +} + +//	Check for interrupts +//	TODO: VBUS detection +bool USBDevice_::configured() +{ +	return _usbConfiguration; +} + +void USBDevice_::poll() +{ +} + +bool USBDevice_::wakeupHost() +{ +	// clear any previous wakeup request which might have been set but could be processed at that time +	// e.g. because the host was not suspended at that time +	UDCON &= ~(1 << RMWKUP); + +	if(!(UDCON & (1 << RMWKUP)) +	  && (_usbSuspendState & (1<<SUSPI)) +	  && (_usbCurrentStatus & FEATURE_REMOTE_WAKEUP_ENABLED)) +	{ +		// This short version will only work, when the device has not been suspended. Currently the +		// Arduino core doesn't handle SUSPEND at all, so this is ok. +		USB_ClockEnable(); +		UDCON |= (1 << RMWKUP); // send the wakeup request +		return true; +	} + +	return false; +} + +bool USBDevice_::isSuspended() +{ +	return (_usbSuspendState & (1 << SUSPI)); +} + + +#endif /* if defined(USBCON) */ diff --git a/cores/xinput/USBCore.h b/cores/xinput/USBCore.h new file mode 100644 index 0000000..578e1b8 --- /dev/null +++ b/cores/xinput/USBCore.h @@ -0,0 +1,197 @@ + +// Copyright (c) 2010, Peter Barrett  +/* +** Permission to use, copy, modify, and/or distribute this software for   +** any purpose with or without fee is hereby granted, provided that the   +** above copyright notice and this permission notice appear in all copies.   +**   +** THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL   +** WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED   +** WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR   +** BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES   +** OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,   +** WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,   +** ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS   +** SOFTWARE.   +*/ + +#ifndef __USBCORE_H__ +#define __USBCORE_H__ + +#include "USBAPI.h" + +//	Standard requests +#define GET_STATUS			0 +#define CLEAR_FEATURE		1 +#define SET_FEATURE			3 +#define SET_ADDRESS			5 +#define GET_DESCRIPTOR		6 +#define SET_DESCRIPTOR		7 +#define GET_CONFIGURATION	8 +#define SET_CONFIGURATION	9 +#define GET_INTERFACE		10 +#define SET_INTERFACE		11 + + +// bmRequestType +#define REQUEST_HOSTTODEVICE	0x00 +#define REQUEST_DEVICETOHOST	0x80 +#define REQUEST_DIRECTION		0x80 + +#define REQUEST_STANDARD		0x00 +#define REQUEST_CLASS			0x20 +#define REQUEST_VENDOR			0x40 +#define REQUEST_TYPE			0x60 + +#define REQUEST_DEVICE			0x00 +#define REQUEST_INTERFACE		0x01 +#define REQUEST_ENDPOINT		0x02 +#define REQUEST_OTHER			0x03 +#define REQUEST_RECIPIENT		0x03 + +#define REQUEST_DEVICETOHOST_CLASS_INTERFACE    (REQUEST_DEVICETOHOST | REQUEST_CLASS | REQUEST_INTERFACE) +#define REQUEST_HOSTTODEVICE_CLASS_INTERFACE    (REQUEST_HOSTTODEVICE | REQUEST_CLASS | REQUEST_INTERFACE) +#define REQUEST_DEVICETOHOST_STANDARD_INTERFACE (REQUEST_DEVICETOHOST | REQUEST_STANDARD | REQUEST_INTERFACE) + +//	Descriptors + +#define USB_DEVICE_DESC_SIZE 18 +#define USB_CONFIGUARTION_DESC_SIZE 9 +#define USB_INTERFACE_DESC_SIZE 9 +#define USB_ENDPOINT_DESC_SIZE 7 + +#define USB_DEVICE_DESCRIPTOR_TYPE             1 +#define USB_CONFIGURATION_DESCRIPTOR_TYPE      2 +#define USB_STRING_DESCRIPTOR_TYPE             3 +#define USB_INTERFACE_DESCRIPTOR_TYPE          4 +#define USB_ENDPOINT_DESCRIPTOR_TYPE           5 + +// usb_20.pdf Table 9.6 Standard Feature Selectors +#define DEVICE_REMOTE_WAKEUP                   1 +#define ENDPOINT_HALT                          2 +#define TEST_MODE                              3 + +// usb_20.pdf Figure 9-4. Information Returned by a GetStatus() Request to a Device +#define FEATURE_SELFPOWERED_ENABLED     (1 << 0) +#define FEATURE_REMOTE_WAKEUP_ENABLED   (1 << 1) + +#define USB_DEVICE_CLASS_COMMUNICATIONS        0x02 +#define USB_DEVICE_CLASS_HUMAN_INTERFACE       0x03 +#define USB_DEVICE_CLASS_STORAGE               0x08 +#define USB_DEVICE_CLASS_VENDOR_SPECIFIC       0xFF + +#define USB_CONFIG_POWERED_MASK                0x40 +#define USB_CONFIG_BUS_POWERED                 0x80 +#define USB_CONFIG_SELF_POWERED                0xC0 +#define USB_CONFIG_REMOTE_WAKEUP               0x20 + +// bMaxPower in Configuration Descriptor +#define USB_CONFIG_POWER_MA(mA)                ((mA)/2) +#ifndef USB_CONFIG_POWER + #define USB_CONFIG_POWER                      (500) +#endif + +// bEndpointAddress in Endpoint Descriptor +#define USB_ENDPOINT_DIRECTION_MASK            0x80 +#define USB_ENDPOINT_OUT(addr)                 (lowByte((addr) | 0x00)) +#define USB_ENDPOINT_IN(addr)                  (lowByte((addr) | 0x80)) + +#define USB_ENDPOINT_TYPE_MASK                 0x03 +#define USB_ENDPOINT_TYPE_CONTROL              0x00 +#define USB_ENDPOINT_TYPE_ISOCHRONOUS          0x01 +#define USB_ENDPOINT_TYPE_BULK                 0x02 +#define USB_ENDPOINT_TYPE_INTERRUPT            0x03 + +#define TOBYTES(x) ((x) & 0xFF),(((x) >> 8) & 0xFF) + +#ifndef USB_VERSION +#define USB_VERSION 0x200 +#endif + +//	Device +typedef struct { +	u8 len;				// 18 +	u8 dtype;			// 1 USB_DEVICE_DESCRIPTOR_TYPE +	u16 usbVersion;		// 0x200 or 0x210 +	u8	deviceClass; +	u8	deviceSubClass; +	u8	deviceProtocol; +	u8	packetSize0;	// Packet 0 +	u16	idVendor; +	u16	idProduct; +	u16	deviceVersion;	// 0x100 +	u8	iManufacturer; +	u8	iProduct; +	u8	iSerialNumber; +	u8	bNumConfigurations; +} DeviceDescriptor; + +//	Config +typedef struct { +	u8	len;			// 9 +	u8	dtype;			// 2 +	u16 clen;			// total length +	u8	numInterfaces; +	u8	config; +	u8	iconfig; +	u8	attributes; +	u8	maxPower; +} ConfigDescriptor; + +//	String + +//	Interface +typedef struct +{ +	u8 len;		// 9 +	u8 dtype;	// 4 +	u8 number; +	u8 alternate; +	u8 numEndpoints; +	u8 interfaceClass; +	u8 interfaceSubClass; +	u8 protocol; +	u8 iInterface; +} InterfaceDescriptor; + +//	Endpoint +typedef struct +{ +	u8 len;		// 7 +	u8 dtype;	// 5 +	u8 addr; +	u8 attr; +	u16 packetSize; +	u8 interval; +} EndpointDescriptor; + +#define D_DEVICE(_class,_subClass,_proto,_packetSize0,_vid,_pid,_version,_im,_ip,_is,_configs) \ +	{ 18, 1, USB_VERSION, _class,_subClass,_proto,_packetSize0,_vid,_pid,_version,_im,_ip,_is,_configs } + +#define D_CONFIG(_totalLength,_interfaces) \ +	{ 9, 2, _totalLength,_interfaces, 1, 0, USB_CONFIG_BUS_POWERED | USB_CONFIG_REMOTE_WAKEUP, USB_CONFIG_POWER_MA(USB_CONFIG_POWER) } + +#define D_INTERFACE(_n,_numEndpoints,_class,_subClass,_protocol) \ +	{ 9, 4, _n, 0, _numEndpoints, _class,_subClass, _protocol, 0 } + +#define D_ENDPOINT(_addr,_attr,_packetSize, _interval) \ +	{ 7, 5, _addr,_attr,_packetSize, _interval } + +// Bootloader related fields +// Old Caterina bootloader places the MAGIC key into unsafe RAM locations (it can be rewritten +// by the running sketch before to actual reboot). +// Newer bootloaders, recognizable by the LUFA "signature" at the end of the flash, can handle both +// the usafe and the safe location. +#ifndef MAGIC_KEY +#define MAGIC_KEY 0x7777 +#endif + +#ifndef MAGIC_KEY_POS +#define MAGIC_KEY_POS 0x0800 +#endif + +#ifndef NEW_LUFA_SIGNATURE +#define NEW_LUFA_SIGNATURE 0xDCFB +#endif + +#endif diff --git a/cores/xinput/USBDesc.h b/cores/xinput/USBDesc.h new file mode 100644 index 0000000..fe1af92 --- /dev/null +++ b/cores/xinput/USBDesc.h @@ -0,0 +1,29 @@ +/* +   Copyright (c) 2011, Peter Barrett +   Copyright (c) 2015, Arduino LLC + +   Permission to use, copy, modify, and/or distribute this software for +   any purpose with or without fee is hereby granted, provided that the +   above copyright notice and this permission notice appear in all copies. + +   THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL +   WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED +   WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR +   BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES +   OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, +   WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, +   ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS +   SOFTWARE. + */ + +// #define PLUGGABLE_USB_ENABLED  // Not compatible with XInput + +#if defined(EPRST6) +#define USB_ENDPOINTS 7 // AtMegaxxU4 +#else +#define USB_ENDPOINTS 5 // AtMegaxxU2 +#endif + +#define IMANUFACTURER   1 +#define IPRODUCT        2 +#define ISERIAL         3
\ No newline at end of file diff --git a/cores/xinput/Udp.h b/cores/xinput/Udp.h new file mode 100644 index 0000000..89f31c6 --- /dev/null +++ b/cores/xinput/Udp.h @@ -0,0 +1,89 @@ +/* + *  Udp.cpp: Library to send/receive UDP packets. + * + * NOTE: UDP is fast, but has some important limitations (thanks to Warren Gray for mentioning these) + * 1) UDP does not guarantee the order in which assembled UDP packets are received. This + * might not happen often in practice, but in larger network topologies, a UDP + * packet can be received out of sequence.  + * 2) UDP does not guard against lost packets - so packets *can* disappear without the sender being + * aware of it. Again, this may not be a concern in practice on small local networks. + * For more information, see http://www.cafeaulait.org/course/week12/35.html + * + * MIT License: + * Copyright (c) 2008 Bjoern Hartmann + * 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. + * + * bjoern@cs.stanford.edu 12/30/2008 + */ + +#ifndef udp_h +#define udp_h + +#include <Stream.h> +#include <IPAddress.h> + +class UDP : public Stream { + +public: +  virtual uint8_t begin(uint16_t) =0;  // initialize, start listening on specified port. Returns 1 if successful, 0 if there are no sockets available to use +  virtual uint8_t beginMulticast(IPAddress, uint16_t) { return 0; }  // initialize, start listening on specified multicast IP address and port. Returns 1 if successful, 0 on failure +  virtual void stop() =0;  // Finish with the UDP socket + +  // Sending UDP packets +   +  // Start building up a packet to send to the remote host specific in ip and port +  // Returns 1 if successful, 0 if there was a problem with the supplied IP address or port +  virtual int beginPacket(IPAddress ip, uint16_t port) =0; +  // Start building up a packet to send to the remote host specific in host and port +  // Returns 1 if successful, 0 if there was a problem resolving the hostname or port +  virtual int beginPacket(const char *host, uint16_t port) =0; +  // Finish off this packet and send it +  // Returns 1 if the packet was sent successfully, 0 if there was an error +  virtual int endPacket() =0; +  // Write a single byte into the packet +  virtual size_t write(uint8_t) =0; +  // Write size bytes from buffer into the packet +  virtual size_t write(const uint8_t *buffer, size_t size) =0; + +  // Start processing the next available incoming packet +  // Returns the size of the packet in bytes, or 0 if no packets are available +  virtual int parsePacket() =0; +  // Number of bytes remaining in the current packet +  virtual int available() =0; +  // Read a single byte from the current packet +  virtual int read() =0; +  // Read up to len bytes from the current packet and place them into buffer +  // Returns the number of bytes read, or 0 if none are available +  virtual int read(unsigned char* buffer, size_t len) =0; +  // Read up to len characters from the current packet and place them into buffer +  // Returns the number of characters read, or 0 if none are available +  virtual int read(char* buffer, size_t len) =0; +  // Return the next byte from the current packet without moving on to the next byte +  virtual int peek() =0; +  virtual void flush() =0;	// Finish reading the current packet + +  // Return the IP address of the host who sent the current incoming packet +  virtual IPAddress remoteIP() =0; +  // Return the port of the host who sent the current incoming packet +  virtual uint16_t remotePort() =0; +protected: +  uint8_t* rawIPAddress(IPAddress& addr) { return addr.raw_address(); }; +}; + +#endif diff --git a/cores/xinput/WCharacter.h b/cores/xinput/WCharacter.h new file mode 100644 index 0000000..79733b5 --- /dev/null +++ b/cores/xinput/WCharacter.h @@ -0,0 +1,168 @@ +/* + WCharacter.h - Character utility functions for Wiring & Arduino + Copyright (c) 2010 Hernando Barragan.  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 + */ + +#ifndef Character_h +#define Character_h + +#include <ctype.h> + +// WCharacter.h prototypes +inline boolean isAlphaNumeric(int c) __attribute__((always_inline)); +inline boolean isAlpha(int c) __attribute__((always_inline)); +inline boolean isAscii(int c) __attribute__((always_inline)); +inline boolean isWhitespace(int c) __attribute__((always_inline)); +inline boolean isControl(int c) __attribute__((always_inline)); +inline boolean isDigit(int c) __attribute__((always_inline)); +inline boolean isGraph(int c) __attribute__((always_inline)); +inline boolean isLowerCase(int c) __attribute__((always_inline)); +inline boolean isPrintable(int c) __attribute__((always_inline)); +inline boolean isPunct(int c) __attribute__((always_inline)); +inline boolean isSpace(int c) __attribute__((always_inline)); +inline boolean isUpperCase(int c) __attribute__((always_inline)); +inline boolean isHexadecimalDigit(int c) __attribute__((always_inline)); +inline int toAscii(int c) __attribute__((always_inline)); +inline int toLowerCase(int c) __attribute__((always_inline)); +inline int toUpperCase(int c)__attribute__((always_inline)); + + +// Checks for an alphanumeric character.  +// It is equivalent to (isalpha(c) || isdigit(c)). +inline boolean isAlphaNumeric(int c)  +{ +  return ( isalnum(c) == 0 ? false : true); +} + + +// Checks for an alphabetic character.  +// It is equivalent to (isupper(c) || islower(c)). +inline boolean isAlpha(int c) +{ +  return ( isalpha(c) == 0 ? false : true); +} + + +// Checks whether c is a 7-bit unsigned char value  +// that fits into the ASCII character set. +inline boolean isAscii(int c) +{ +  return ( isascii (c) == 0 ? false : true); +} + + +// Checks for a blank character, that is, a space or a tab. +inline boolean isWhitespace(int c) +{ +  return ( isblank (c) == 0 ? false : true); +} + + +// Checks for a control character. +inline boolean isControl(int c) +{ +  return ( iscntrl (c) == 0 ? false : true); +} + + +// Checks for a digit (0 through 9). +inline boolean isDigit(int c) +{ +  return ( isdigit (c) == 0 ? false : true); +} + + +// Checks for any printable character except space. +inline boolean isGraph(int c) +{ +  return ( isgraph (c) == 0 ? false : true); +} + + +// Checks for a lower-case character. +inline boolean isLowerCase(int c) +{ +  return (islower (c) == 0 ? false : true); +} + + +// Checks for any printable character including space. +inline boolean isPrintable(int c) +{ +  return ( isprint (c) == 0 ? false : true); +} + + +// Checks for any printable character which is not a space  +// or an alphanumeric character. +inline boolean isPunct(int c) +{ +  return ( ispunct (c) == 0 ? false : true); +} + + +// Checks for white-space characters. For the avr-libc library,  +// these are: space, formfeed ('\f'), newline ('\n'), carriage  +// return ('\r'), horizontal tab ('\t'), and vertical tab ('\v'). +inline boolean isSpace(int c) +{ +  return ( isspace (c) == 0 ? false : true); +} + + +// Checks for an uppercase letter. +inline boolean isUpperCase(int c) +{ +  return ( isupper (c) == 0 ? false : true); +} + + +// Checks for a hexadecimal digits, i.e. one of 0 1 2 3 4 5 6 7  +// 8 9 a b c d e f A B C D E F. +inline boolean isHexadecimalDigit(int c) +{ +  return ( isxdigit (c) == 0 ? false : true); +} + + +// Converts c to a 7-bit unsigned char value that fits into the  +// ASCII character set, by clearing the high-order bits. +inline int toAscii(int c) +{ +  return toascii (c); +} + + +// Warning: +// Many people will be unhappy if you use this function.  +// This function will convert accented letters into random  +// characters. + +// Converts the letter c to lower case, if possible. +inline int toLowerCase(int c) +{ +  return tolower (c); +} + + +// Converts the letter c to upper case, if possible. +inline int toUpperCase(int c) +{ +  return toupper (c); +} + +#endif
\ No newline at end of file diff --git a/cores/xinput/WInterrupts.c b/cores/xinput/WInterrupts.c new file mode 100644 index 0000000..38ea158 --- /dev/null +++ b/cores/xinput/WInterrupts.c @@ -0,0 +1,379 @@ +/* -*- mode: jde; c-basic-offset: 2; indent-tabs-mode: nil -*- */ + +/* +  Part of the Wiring project - http://wiring.uniandes.edu.co + +  Copyright (c) 2004-05 Hernando Barragan + +  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., 59 Temple Place, Suite 330, +  Boston, MA  02111-1307  USA +   +  Modified 24 November 2006 by David A. Mellis +  Modified 1 August 2010 by Mark Sproul +*/ + +#include <inttypes.h> +#include <avr/io.h> +#include <avr/interrupt.h> +#include <avr/pgmspace.h> +#include <stdio.h> + +#include "wiring_private.h" + +static void nothing(void) { +} + +static volatile voidFuncPtr intFunc[EXTERNAL_NUM_INTERRUPTS] = { +#if EXTERNAL_NUM_INTERRUPTS > 8 +    #warning There are more than 8 external interrupts. Some callbacks may not be initialized. +    nothing, +#endif +#if EXTERNAL_NUM_INTERRUPTS > 7 +    nothing, +#endif +#if EXTERNAL_NUM_INTERRUPTS > 6 +    nothing, +#endif +#if EXTERNAL_NUM_INTERRUPTS > 5 +    nothing, +#endif +#if EXTERNAL_NUM_INTERRUPTS > 4 +    nothing, +#endif +#if EXTERNAL_NUM_INTERRUPTS > 3 +    nothing, +#endif +#if EXTERNAL_NUM_INTERRUPTS > 2 +    nothing, +#endif +#if EXTERNAL_NUM_INTERRUPTS > 1 +    nothing, +#endif +#if EXTERNAL_NUM_INTERRUPTS > 0 +    nothing, +#endif +}; + +void attachInterrupt(uint8_t interruptNum, void (*userFunc)(void), int mode) { +  if(interruptNum < EXTERNAL_NUM_INTERRUPTS) { +    intFunc[interruptNum] = userFunc; +     +    // Configure the interrupt mode (trigger on low input, any change, rising +    // edge, or falling edge).  The mode constants were chosen to correspond +    // to the configuration bits in the hardware register, so we simply shift +    // the mode into place. +       +    // Enable the interrupt. +       +    switch (interruptNum) { +#if defined(__AVR_ATmega32U4__) +	// I hate doing this, but the register assignment differs between the 1280/2560 +	// and the 32U4.  Since avrlib defines registers PCMSK1 and PCMSK2 that aren't  +	// even present on the 32U4 this is the only way to distinguish between them. +    case 0: +	EICRA = (EICRA & ~((1<<ISC00) | (1<<ISC01))) | (mode << ISC00); +	EIMSK |= (1<<INT0); +	break; +    case 1: +	EICRA = (EICRA & ~((1<<ISC10) | (1<<ISC11))) | (mode << ISC10); +	EIMSK |= (1<<INT1); +	break;	 +    case 2: +        EICRA = (EICRA & ~((1<<ISC20) | (1<<ISC21))) | (mode << ISC20); +        EIMSK |= (1<<INT2); +        break; +    case 3: +        EICRA = (EICRA & ~((1<<ISC30) | (1<<ISC31))) | (mode << ISC30); +        EIMSK |= (1<<INT3); +        break; +    case 4: +        EICRB = (EICRB & ~((1<<ISC60) | (1<<ISC61))) | (mode << ISC60); +        EIMSK |= (1<<INT6); +        break; +#elif defined(__AVR_AT90USB82__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega8U2__) +    case 0: +      EICRA = (EICRA & ~((1 << ISC00) | (1 << ISC01))) | (mode << ISC00); +      EIMSK |= (1 << INT0); +      break; +    case 1: +      EICRA = (EICRA & ~((1 << ISC10) | (1 << ISC11))) | (mode << ISC10); +      EIMSK |= (1 << INT1); +      break; +    case 2: +      EICRA = (EICRA & ~((1 << ISC20) | (1 << ISC21))) | (mode << ISC20); +      EIMSK |= (1 << INT2); +      break; +    case 3: +      EICRA = (EICRA & ~((1 << ISC30) | (1 << ISC31))) | (mode << ISC30); +      EIMSK |= (1 << INT3); +      break; +    case 4: +      EICRB = (EICRB & ~((1 << ISC40) | (1 << ISC41))) | (mode << ISC40); +      EIMSK |= (1 << INT4); +      break; +    case 5: +      EICRB = (EICRB & ~((1 << ISC50) | (1 << ISC51))) | (mode << ISC50); +      EIMSK |= (1 << INT5); +      break; +    case 6: +      EICRB = (EICRB & ~((1 << ISC60) | (1 << ISC61))) | (mode << ISC60); +      EIMSK |= (1 << INT6); +      break; +    case 7: +      EICRB = (EICRB & ~((1 << ISC70) | (1 << ISC71))) | (mode << ISC70); +      EIMSK |= (1 << INT7); +      break; +#elif defined(EICRA) && defined(EICRB) && defined(EIMSK) +    case 2: +      EICRA = (EICRA & ~((1 << ISC00) | (1 << ISC01))) | (mode << ISC00); +      EIMSK |= (1 << INT0); +      break; +    case 3: +      EICRA = (EICRA & ~((1 << ISC10) | (1 << ISC11))) | (mode << ISC10); +      EIMSK |= (1 << INT1); +      break; +    case 4: +      EICRA = (EICRA & ~((1 << ISC20) | (1 << ISC21))) | (mode << ISC20); +      EIMSK |= (1 << INT2); +      break; +    case 5: +      EICRA = (EICRA & ~((1 << ISC30) | (1 << ISC31))) | (mode << ISC30); +      EIMSK |= (1 << INT3); +      break; +    case 0: +      EICRB = (EICRB & ~((1 << ISC40) | (1 << ISC41))) | (mode << ISC40); +      EIMSK |= (1 << INT4); +      break; +    case 1: +      EICRB = (EICRB & ~((1 << ISC50) | (1 << ISC51))) | (mode << ISC50); +      EIMSK |= (1 << INT5); +      break; +    case 6: +      EICRB = (EICRB & ~((1 << ISC60) | (1 << ISC61))) | (mode << ISC60); +      EIMSK |= (1 << INT6); +      break; +    case 7: +      EICRB = (EICRB & ~((1 << ISC70) | (1 << ISC71))) | (mode << ISC70); +      EIMSK |= (1 << INT7); +      break; +#else		 +    case 0: +    #if defined(EICRA) && defined(ISC00) && defined(EIMSK) +      EICRA = (EICRA & ~((1 << ISC00) | (1 << ISC01))) | (mode << ISC00); +      EIMSK |= (1 << INT0); +    #elif defined(MCUCR) && defined(ISC00) && defined(GICR) +      MCUCR = (MCUCR & ~((1 << ISC00) | (1 << ISC01))) | (mode << ISC00); +      GICR |= (1 << INT0); +    #elif defined(MCUCR) && defined(ISC00) && defined(GIMSK) +      MCUCR = (MCUCR & ~((1 << ISC00) | (1 << ISC01))) | (mode << ISC00); +      GIMSK |= (1 << INT0); +    #else +      #error attachInterrupt not finished for this CPU (case 0) +    #endif +      break; + +    case 1: +    #if defined(EICRA) && defined(ISC10) && defined(ISC11) && defined(EIMSK) +      EICRA = (EICRA & ~((1 << ISC10) | (1 << ISC11))) | (mode << ISC10); +      EIMSK |= (1 << INT1); +    #elif defined(MCUCR) && defined(ISC10) && defined(ISC11) && defined(GICR) +      MCUCR = (MCUCR & ~((1 << ISC10) | (1 << ISC11))) | (mode << ISC10); +      GICR |= (1 << INT1); +    #elif defined(MCUCR) && defined(ISC10) && defined(GIMSK) && defined(GIMSK) +      MCUCR = (MCUCR & ~((1 << ISC10) | (1 << ISC11))) | (mode << ISC10); +      GIMSK |= (1 << INT1); +    #else +      #warning attachInterrupt may need some more work for this cpu (case 1) +    #endif +      break; +     +    case 2: +    #if defined(EICRA) && defined(ISC20) && defined(ISC21) && defined(EIMSK) +      EICRA = (EICRA & ~((1 << ISC20) | (1 << ISC21))) | (mode << ISC20); +      EIMSK |= (1 << INT2); +    #elif defined(MCUCR) && defined(ISC20) && defined(ISC21) && defined(GICR) +      MCUCR = (MCUCR & ~((1 << ISC20) | (1 << ISC21))) | (mode << ISC20); +      GICR |= (1 << INT2); +    #elif defined(MCUCR) && defined(ISC20) && defined(GIMSK) && defined(GIMSK) +      MCUCR = (MCUCR & ~((1 << ISC20) | (1 << ISC21))) | (mode << ISC20); +      GIMSK |= (1 << INT2); +    #endif +      break; +#endif +    } +  } +} + +void detachInterrupt(uint8_t interruptNum) { +  if(interruptNum < EXTERNAL_NUM_INTERRUPTS) { +    // Disable the interrupt.  (We can't assume that interruptNum is equal +    // to the number of the EIMSK bit to clear, as this isn't true on the  +    // ATmega8.  There, INT0 is 6 and INT1 is 7.) +    switch (interruptNum) { +#if defined(__AVR_ATmega32U4__) +    case 0: +        EIMSK &= ~(1<<INT0); +        break; +    case 1: +        EIMSK &= ~(1<<INT1); +        break; +    case 2: +        EIMSK &= ~(1<<INT2); +        break; +    case 3: +        EIMSK &= ~(1<<INT3); +        break;	 +    case 4: +        EIMSK &= ~(1<<INT6); +        break; +#elif defined(__AVR_AT90USB82__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega8U2__) +    case 0: +      EIMSK &= ~(1 << INT0); +      break; +    case 1: +      EIMSK &= ~(1 << INT1); +      break; +    case 2: +      EIMSK &= ~(1 << INT2); +      break; +    case 3: +      EIMSK &= ~(1 << INT3); +      break; +    case 4: +      EIMSK &= ~(1 << INT4); +      break; +    case 5: +      EIMSK &= ~(1 << INT5); +      break; +    case 6: +      EIMSK &= ~(1 << INT6); +      break; +    case 7: +      EIMSK &= ~(1 << INT7); +      break; +#elif defined(EICRA) && defined(EICRB) && defined(EIMSK) +    case 2: +      EIMSK &= ~(1 << INT0); +      break; +    case 3: +      EIMSK &= ~(1 << INT1); +      break; +    case 4: +      EIMSK &= ~(1 << INT2); +      break; +    case 5: +      EIMSK &= ~(1 << INT3); +      break; +    case 0: +      EIMSK &= ~(1 << INT4); +      break; +    case 1: +      EIMSK &= ~(1 << INT5); +      break; +    case 6: +      EIMSK &= ~(1 << INT6); +      break; +    case 7: +      EIMSK &= ~(1 << INT7); +      break; +#else +    case 0: +    #if defined(EIMSK) && defined(INT0) +      EIMSK &= ~(1 << INT0); +    #elif defined(GICR) && defined(ISC00) +      GICR &= ~(1 << INT0); // atmega32 +    #elif defined(GIMSK) && defined(INT0) +      GIMSK &= ~(1 << INT0); +    #else +      #error detachInterrupt not finished for this cpu +    #endif +      break; + +    case 1: +    #if defined(EIMSK) && defined(INT1) +      EIMSK &= ~(1 << INT1); +    #elif defined(GICR) && defined(INT1) +      GICR &= ~(1 << INT1); // atmega32 +    #elif defined(GIMSK) && defined(INT1) +      GIMSK &= ~(1 << INT1); +    #else +      #warning detachInterrupt may need some more work for this cpu (case 1) +    #endif +      break; +       +    case 2: +    #if defined(EIMSK) && defined(INT2) +      EIMSK &= ~(1 << INT2); +    #elif defined(GICR) && defined(INT2) +      GICR &= ~(1 << INT2); // atmega32 +    #elif defined(GIMSK) && defined(INT2) +      GIMSK &= ~(1 << INT2); +    #elif defined(INT2) +      #warning detachInterrupt may need some more work for this cpu (case 2) +    #endif +      break;        +#endif +    } +       +    intFunc[interruptNum] = nothing; +  } +} + + +#define IMPLEMENT_ISR(vect, interrupt) \ +  ISR(vect) { \ +    intFunc[interrupt](); \ +  } + +#if defined(__AVR_ATmega32U4__) + +IMPLEMENT_ISR(INT0_vect, EXTERNAL_INT_0) +IMPLEMENT_ISR(INT1_vect, EXTERNAL_INT_1) +IMPLEMENT_ISR(INT2_vect, EXTERNAL_INT_2) +IMPLEMENT_ISR(INT3_vect, EXTERNAL_INT_3) +IMPLEMENT_ISR(INT6_vect, EXTERNAL_INT_4) + +#elif defined(__AVR_AT90USB82__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega8U2__) + +IMPLEMENT_ISR(INT0_vect, EXTERNAL_INT_0) +IMPLEMENT_ISR(INT1_vect, EXTERNAL_INT_1) +IMPLEMENT_ISR(INT2_vect, EXTERNAL_INT_2) +IMPLEMENT_ISR(INT3_vect, EXTERNAL_INT_3) +IMPLEMENT_ISR(INT4_vect, EXTERNAL_INT_4) +IMPLEMENT_ISR(INT5_vect, EXTERNAL_INT_5) +IMPLEMENT_ISR(INT6_vect, EXTERNAL_INT_6) +IMPLEMENT_ISR(INT7_vect, EXTERNAL_INT_7) + +#elif defined(EICRA) && defined(EICRB) + +IMPLEMENT_ISR(INT0_vect, EXTERNAL_INT_2) +IMPLEMENT_ISR(INT1_vect, EXTERNAL_INT_3) +IMPLEMENT_ISR(INT2_vect, EXTERNAL_INT_4) +IMPLEMENT_ISR(INT3_vect, EXTERNAL_INT_5) +IMPLEMENT_ISR(INT4_vect, EXTERNAL_INT_0) +IMPLEMENT_ISR(INT5_vect, EXTERNAL_INT_1) +IMPLEMENT_ISR(INT6_vect, EXTERNAL_INT_6) +IMPLEMENT_ISR(INT7_vect, EXTERNAL_INT_7) + +#else + +IMPLEMENT_ISR(INT0_vect, EXTERNAL_INT_0) +IMPLEMENT_ISR(INT1_vect, EXTERNAL_INT_1) + +#if defined(EICRA) && defined(ISC20) +IMPLEMENT_ISR(INT2_vect, EXTERNAL_INT_2) +#endif + +#endif diff --git a/cores/xinput/WMath.cpp b/cores/xinput/WMath.cpp new file mode 100644 index 0000000..9fb072f --- /dev/null +++ b/cores/xinput/WMath.cpp @@ -0,0 +1,58 @@ +/* -*- mode: jde; c-basic-offset: 2; indent-tabs-mode: nil -*- */ + +/* +  Part of the Wiring project - http://wiring.org.co +  Copyright (c) 2004-06 Hernando Barragan +  Modified 13 August 2006, David A. Mellis for Arduino - http://www.arduino.cc/ +   +  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., 59 Temple Place, Suite 330, +  Boston, MA  02111-1307  USA +*/ + +extern "C" { +  #include "stdlib.h" +} + +void randomSeed(unsigned long seed) +{ +  if (seed != 0) { +    srandom(seed); +  } +} + +long random(long howbig) +{ +  if (howbig == 0) { +    return 0; +  } +  return random() % howbig; +} + +long random(long howsmall, long howbig) +{ +  if (howsmall >= howbig) { +    return howsmall; +  } +  long diff = howbig - howsmall; +  return random(diff) + howsmall; +} + +long map(long x, long in_min, long in_max, long out_min, long out_max) +{ +  return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min; +} + +unsigned int makeWord(unsigned int w) { return w; } +unsigned int makeWord(unsigned char h, unsigned char l) { return (h << 8) | l; } diff --git a/cores/xinput/WString.cpp b/cores/xinput/WString.cpp new file mode 100644 index 0000000..043fda7 --- /dev/null +++ b/cores/xinput/WString.cpp @@ -0,0 +1,750 @@ +/* +  WString.cpp - String library for Wiring & Arduino +  ...mostly rewritten by Paul Stoffregen... +  Copyright (c) 2009-10 Hernando Barragan.  All rights reserved. +  Copyright 2011, Paul Stoffregen, paul@pjrc.com + +  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 +*/ + +#include "WString.h" + +/*********************************************/ +/*  Constructors                             */ +/*********************************************/ + +String::String(const char *cstr) +{ +	init(); +	if (cstr) copy(cstr, strlen(cstr)); +} + +String::String(const String &value) +{ +	init(); +	*this = value; +} + +String::String(const __FlashStringHelper *pstr) +{ +	init(); +	*this = pstr; +} + +#if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__) +String::String(String &&rval) +{ +	init(); +	move(rval); +} +String::String(StringSumHelper &&rval) +{ +	init(); +	move(rval); +} +#endif + +String::String(char c) +{ +	init(); +	char buf[2]; +	buf[0] = c; +	buf[1] = 0; +	*this = buf; +} + +String::String(unsigned char value, unsigned char base) +{ +	init(); +	char buf[1 + 8 * sizeof(unsigned char)]; +	utoa(value, buf, base); +	*this = buf; +} + +String::String(int value, unsigned char base) +{ +	init(); +	char buf[2 + 8 * sizeof(int)]; +	itoa(value, buf, base); +	*this = buf; +} + +String::String(unsigned int value, unsigned char base) +{ +	init(); +	char buf[1 + 8 * sizeof(unsigned int)]; +	utoa(value, buf, base); +	*this = buf; +} + +String::String(long value, unsigned char base) +{ +	init(); +	char buf[2 + 8 * sizeof(long)]; +	ltoa(value, buf, base); +	*this = buf; +} + +String::String(unsigned long value, unsigned char base) +{ +	init(); +	char buf[1 + 8 * sizeof(unsigned long)]; +	ultoa(value, buf, base); +	*this = buf; +} + +String::String(float value, unsigned char decimalPlaces) +{ +	init(); +	char buf[33]; +	*this = dtostrf(value, (decimalPlaces + 2), decimalPlaces, buf); +} + +String::String(double value, unsigned char decimalPlaces) +{ +	init(); +	char buf[33]; +	*this = dtostrf(value, (decimalPlaces + 2), decimalPlaces, buf); +} + +String::~String() +{ +	if (buffer) free(buffer); +} + +/*********************************************/ +/*  Memory Management                        */ +/*********************************************/ + +inline void String::init(void) +{ +	buffer = NULL; +	capacity = 0; +	len = 0; +} + +void String::invalidate(void) +{ +	if (buffer) free(buffer); +	buffer = NULL; +	capacity = len = 0; +} + +unsigned char String::reserve(unsigned int size) +{ +	if (buffer && capacity >= size) return 1; +	if (changeBuffer(size)) { +		if (len == 0) buffer[0] = 0; +		return 1; +	} +	return 0; +} + +unsigned char String::changeBuffer(unsigned int maxStrLen) +{ +	char *newbuffer = (char *)realloc(buffer, maxStrLen + 1); +	if (newbuffer) { +		buffer = newbuffer; +		capacity = maxStrLen; +		return 1; +	} +	return 0; +} + +/*********************************************/ +/*  Copy and Move                            */ +/*********************************************/ + +String & String::copy(const char *cstr, unsigned int length) +{ +	if (!reserve(length)) { +		invalidate(); +		return *this; +	} +	len = length; +	strcpy(buffer, cstr); +	return *this; +} + +String & String::copy(const __FlashStringHelper *pstr, unsigned int length) +{ +	if (!reserve(length)) { +		invalidate(); +		return *this; +	} +	len = length; +	strcpy_P(buffer, (PGM_P)pstr); +	return *this; +} + +#if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__) +void String::move(String &rhs) +{ +	if (buffer) { +		if (rhs && capacity >= rhs.len) { +			strcpy(buffer, rhs.buffer); +			len = rhs.len; +			rhs.len = 0; +			return; +		} else { +			free(buffer); +		} +	} +	buffer = rhs.buffer; +	capacity = rhs.capacity; +	len = rhs.len; +	rhs.buffer = NULL; +	rhs.capacity = 0; +	rhs.len = 0; +} +#endif + +String & String::operator = (const String &rhs) +{ +	if (this == &rhs) return *this; +	 +	if (rhs.buffer) copy(rhs.buffer, rhs.len); +	else invalidate(); +	 +	return *this; +} + +#if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__) +String & String::operator = (String &&rval) +{ +	if (this != &rval) move(rval); +	return *this; +} + +String & String::operator = (StringSumHelper &&rval) +{ +	if (this != &rval) move(rval); +	return *this; +} +#endif + +String & String::operator = (const char *cstr) +{ +	if (cstr) copy(cstr, strlen(cstr)); +	else invalidate(); +	 +	return *this; +} + +String & String::operator = (const __FlashStringHelper *pstr) +{ +	if (pstr) copy(pstr, strlen_P((PGM_P)pstr)); +	else invalidate(); + +	return *this; +} + +/*********************************************/ +/*  concat                                   */ +/*********************************************/ + +unsigned char String::concat(const String &s) +{ +	return concat(s.buffer, s.len); +} + +unsigned char String::concat(const char *cstr, unsigned int length) +{ +	unsigned int newlen = len + length; +	if (!cstr) return 0; +	if (length == 0) return 1; +	if (!reserve(newlen)) return 0; +	strcpy(buffer + len, cstr); +	len = newlen; +	return 1; +} + +unsigned char String::concat(const char *cstr) +{ +	if (!cstr) return 0; +	return concat(cstr, strlen(cstr)); +} + +unsigned char String::concat(char c) +{ +	char buf[2]; +	buf[0] = c; +	buf[1] = 0; +	return concat(buf, 1); +} + +unsigned char String::concat(unsigned char num) +{ +	char buf[1 + 3 * sizeof(unsigned char)]; +	itoa(num, buf, 10); +	return concat(buf, strlen(buf)); +} + +unsigned char String::concat(int num) +{ +	char buf[2 + 3 * sizeof(int)]; +	itoa(num, buf, 10); +	return concat(buf, strlen(buf)); +} + +unsigned char String::concat(unsigned int num) +{ +	char buf[1 + 3 * sizeof(unsigned int)]; +	utoa(num, buf, 10); +	return concat(buf, strlen(buf)); +} + +unsigned char String::concat(long num) +{ +	char buf[2 + 3 * sizeof(long)]; +	ltoa(num, buf, 10); +	return concat(buf, strlen(buf)); +} + +unsigned char String::concat(unsigned long num) +{ +	char buf[1 + 3 * sizeof(unsigned long)]; +	ultoa(num, buf, 10); +	return concat(buf, strlen(buf)); +} + +unsigned char String::concat(float num) +{ +	char buf[20]; +	char* string = dtostrf(num, 4, 2, buf); +	return concat(string, strlen(string)); +} + +unsigned char String::concat(double num) +{ +	char buf[20]; +	char* string = dtostrf(num, 4, 2, buf); +	return concat(string, strlen(string)); +} + +unsigned char String::concat(const __FlashStringHelper * str) +{ +	if (!str) return 0; +	int length = strlen_P((const char *) str); +	if (length == 0) return 1; +	unsigned int newlen = len + length; +	if (!reserve(newlen)) return 0; +	strcpy_P(buffer + len, (const char *) str); +	len = newlen; +	return 1; +} + +/*********************************************/ +/*  Concatenate                              */ +/*********************************************/ + +StringSumHelper & operator + (const StringSumHelper &lhs, const String &rhs) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!a.concat(rhs.buffer, rhs.len)) a.invalidate(); +	return a; +} + +StringSumHelper & operator + (const StringSumHelper &lhs, const char *cstr) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!cstr || !a.concat(cstr, strlen(cstr))) a.invalidate(); +	return a; +} + +StringSumHelper & operator + (const StringSumHelper &lhs, char c) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!a.concat(c)) a.invalidate(); +	return a; +} + +StringSumHelper & operator + (const StringSumHelper &lhs, unsigned char num) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!a.concat(num)) a.invalidate(); +	return a; +} + +StringSumHelper & operator + (const StringSumHelper &lhs, int num) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!a.concat(num)) a.invalidate(); +	return a; +} + +StringSumHelper & operator + (const StringSumHelper &lhs, unsigned int num) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!a.concat(num)) a.invalidate(); +	return a; +} + +StringSumHelper & operator + (const StringSumHelper &lhs, long num) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!a.concat(num)) a.invalidate(); +	return a; +} + +StringSumHelper & operator + (const StringSumHelper &lhs, unsigned long num) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!a.concat(num)) a.invalidate(); +	return a; +} + +StringSumHelper & operator + (const StringSumHelper &lhs, float num) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!a.concat(num)) a.invalidate(); +	return a; +} + +StringSumHelper & operator + (const StringSumHelper &lhs, double num) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!a.concat(num)) a.invalidate(); +	return a; +} + +StringSumHelper & operator + (const StringSumHelper &lhs, const __FlashStringHelper *rhs) +{ +	StringSumHelper &a = const_cast<StringSumHelper&>(lhs); +	if (!a.concat(rhs))	a.invalidate(); +	return a; +} + +/*********************************************/ +/*  Comparison                               */ +/*********************************************/ + +int String::compareTo(const String &s) const +{ +	if (!buffer || !s.buffer) { +		if (s.buffer && s.len > 0) return 0 - *(unsigned char *)s.buffer; +		if (buffer && len > 0) return *(unsigned char *)buffer; +		return 0; +	} +	return strcmp(buffer, s.buffer); +} + +unsigned char String::equals(const String &s2) const +{ +	return (len == s2.len && compareTo(s2) == 0); +} + +unsigned char String::equals(const char *cstr) const +{ +	if (len == 0) return (cstr == NULL || *cstr == 0); +	if (cstr == NULL) return buffer[0] == 0; +	return strcmp(buffer, cstr) == 0; +} + +unsigned char String::operator<(const String &rhs) const +{ +	return compareTo(rhs) < 0; +} + +unsigned char String::operator>(const String &rhs) const +{ +	return compareTo(rhs) > 0; +} + +unsigned char String::operator<=(const String &rhs) const +{ +	return compareTo(rhs) <= 0; +} + +unsigned char String::operator>=(const String &rhs) const +{ +	return compareTo(rhs) >= 0; +} + +unsigned char String::equalsIgnoreCase( const String &s2 ) const +{ +	if (this == &s2) return 1; +	if (len != s2.len) return 0; +	if (len == 0) return 1; +	const char *p1 = buffer; +	const char *p2 = s2.buffer; +	while (*p1) { +		if (tolower(*p1++) != tolower(*p2++)) return 0; +	}  +	return 1; +} + +unsigned char String::startsWith( const String &s2 ) const +{ +	if (len < s2.len) return 0; +	return startsWith(s2, 0); +} + +unsigned char String::startsWith( const String &s2, unsigned int offset ) const +{ +	if (offset > len - s2.len || !buffer || !s2.buffer) return 0; +	return strncmp( &buffer[offset], s2.buffer, s2.len ) == 0; +} + +unsigned char String::endsWith( const String &s2 ) const +{ +	if ( len < s2.len || !buffer || !s2.buffer) return 0; +	return strcmp(&buffer[len - s2.len], s2.buffer) == 0; +} + +/*********************************************/ +/*  Character Access                         */ +/*********************************************/ + +char String::charAt(unsigned int loc) const +{ +	return operator[](loc); +} + +void String::setCharAt(unsigned int loc, char c)  +{ +	if (loc < len) buffer[loc] = c; +} + +char & String::operator[](unsigned int index) +{ +	static char dummy_writable_char; +	if (index >= len || !buffer) { +		dummy_writable_char = 0; +		return dummy_writable_char; +	} +	return buffer[index]; +} + +char String::operator[]( unsigned int index ) const +{ +	if (index >= len || !buffer) return 0; +	return buffer[index]; +} + +void String::getBytes(unsigned char *buf, unsigned int bufsize, unsigned int index) const +{ +	if (!bufsize || !buf) return; +	if (index >= len) { +		buf[0] = 0; +		return; +	} +	unsigned int n = bufsize - 1; +	if (n > len - index) n = len - index; +	strncpy((char *)buf, buffer + index, n); +	buf[n] = 0; +} + +/*********************************************/ +/*  Search                                   */ +/*********************************************/ + +int String::indexOf(char c) const +{ +	return indexOf(c, 0); +} + +int String::indexOf( char ch, unsigned int fromIndex ) const +{ +	if (fromIndex >= len) return -1; +	const char* temp = strchr(buffer + fromIndex, ch); +	if (temp == NULL) return -1; +	return temp - buffer; +} + +int String::indexOf(const String &s2) const +{ +	return indexOf(s2, 0); +} + +int String::indexOf(const String &s2, unsigned int fromIndex) const +{ +	if (fromIndex >= len) return -1; +	const char *found = strstr(buffer + fromIndex, s2.buffer); +	if (found == NULL) return -1; +	return found - buffer; +} + +int String::lastIndexOf( char theChar ) const +{ +	return lastIndexOf(theChar, len - 1); +} + +int String::lastIndexOf(char ch, unsigned int fromIndex) const +{ +	if (fromIndex >= len) return -1; +	char tempchar = buffer[fromIndex + 1]; +	buffer[fromIndex + 1] = '\0'; +	char* temp = strrchr( buffer, ch ); +	buffer[fromIndex + 1] = tempchar; +	if (temp == NULL) return -1; +	return temp - buffer; +} + +int String::lastIndexOf(const String &s2) const +{ +	return lastIndexOf(s2, len - s2.len); +} + +int String::lastIndexOf(const String &s2, unsigned int fromIndex) const +{ +  	if (s2.len == 0 || len == 0 || s2.len > len) return -1; +	if (fromIndex >= len) fromIndex = len - 1; +	int found = -1; +	for (char *p = buffer; p <= buffer + fromIndex; p++) { +		p = strstr(p, s2.buffer); +		if (!p) break; +		if ((unsigned int)(p - buffer) <= fromIndex) found = p - buffer; +	} +	return found; +} + +String String::substring(unsigned int left, unsigned int right) const +{ +	if (left > right) { +		unsigned int temp = right; +		right = left; +		left = temp; +	} +	String out; +	if (left >= len) return out; +	if (right > len) right = len; +	char temp = buffer[right];  // save the replaced character +	buffer[right] = '\0';	 +	out = buffer + left;  // pointer arithmetic +	buffer[right] = temp;  //restore character +	return out; +} + +/*********************************************/ +/*  Modification                             */ +/*********************************************/ + +void String::replace(char find, char replace) +{ +	if (!buffer) return; +	for (char *p = buffer; *p; p++) { +		if (*p == find) *p = replace; +	} +} + +void String::replace(const String& find, const String& replace) +{ +	if (len == 0 || find.len == 0) return; +	int diff = replace.len - find.len; +	char *readFrom = buffer; +	char *foundAt; +	if (diff == 0) { +		while ((foundAt = strstr(readFrom, find.buffer)) != NULL) { +			memcpy(foundAt, replace.buffer, replace.len); +			readFrom = foundAt + replace.len; +		} +	} else if (diff < 0) { +		char *writeTo = buffer; +		while ((foundAt = strstr(readFrom, find.buffer)) != NULL) { +			unsigned int n = foundAt - readFrom; +			memcpy(writeTo, readFrom, n); +			writeTo += n; +			memcpy(writeTo, replace.buffer, replace.len); +			writeTo += replace.len; +			readFrom = foundAt + find.len; +			len += diff; +		} +		strcpy(writeTo, readFrom); +	} else { +		unsigned int size = len; // compute size needed for result +		while ((foundAt = strstr(readFrom, find.buffer)) != NULL) { +			readFrom = foundAt + find.len; +			size += diff; +		} +		if (size == len) return; +		if (size > capacity && !changeBuffer(size)) return; // XXX: tell user! +		int index = len - 1; +		while (index >= 0 && (index = lastIndexOf(find, index)) >= 0) { +			readFrom = buffer + index + find.len; +			memmove(readFrom + diff, readFrom, len - (readFrom - buffer)); +			len += diff; +			buffer[len] = 0; +			memcpy(buffer + index, replace.buffer, replace.len); +			index--; +		} +	} +} + +void String::remove(unsigned int index){ +	// Pass the biggest integer as the count. The remove method +	// below will take care of truncating it at the end of the +	// string. +	remove(index, (unsigned int)-1); +} + +void String::remove(unsigned int index, unsigned int count){ +	if (index >= len) { return; } +	if (count <= 0) { return; } +	if (count > len - index) { count = len - index; } +	char *writeTo = buffer + index; +	len = len - count; +	strncpy(writeTo, buffer + index + count,len - index); +	buffer[len] = 0; +} + +void String::toLowerCase(void) +{ +	if (!buffer) return; +	for (char *p = buffer; *p; p++) { +		*p = tolower(*p); +	} +} + +void String::toUpperCase(void) +{ +	if (!buffer) return; +	for (char *p = buffer; *p; p++) { +		*p = toupper(*p); +	} +} + +void String::trim(void) +{ +	if (!buffer || len == 0) return; +	char *begin = buffer; +	while (isspace(*begin)) begin++; +	char *end = buffer + len - 1; +	while (isspace(*end) && end >= begin) end--; +	len = end + 1 - begin; +	if (begin > buffer) memcpy(buffer, begin, len); +	buffer[len] = 0; +} + +/*********************************************/ +/*  Parsing / Conversion                     */ +/*********************************************/ + +long String::toInt(void) const +{ +	if (buffer) return atol(buffer); +	return 0; +} + +float String::toFloat(void) const +{ +	return float(toDouble()); +} + +double String::toDouble(void) const +{ +	if (buffer) return atof(buffer); +	return 0; +} diff --git a/cores/xinput/WString.h b/cores/xinput/WString.h new file mode 100644 index 0000000..2cf4cd7 --- /dev/null +++ b/cores/xinput/WString.h @@ -0,0 +1,229 @@ +/* +  WString.h - String library for Wiring & Arduino +  ...mostly rewritten by Paul Stoffregen... +  Copyright (c) 2009-10 Hernando Barragan.  All right reserved. +  Copyright 2011, Paul Stoffregen, paul@pjrc.com + +  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 String_class_h +#define String_class_h +#ifdef __cplusplus + +#include <stdlib.h> +#include <string.h> +#include <ctype.h> +#include <avr/pgmspace.h> + +// When compiling programs with this class, the following gcc parameters +// dramatically increase performance and memory (RAM) efficiency, typically +// with little or no increase in code size. +//     -felide-constructors +//     -std=c++0x + +class __FlashStringHelper; +#define F(string_literal) (reinterpret_cast<const __FlashStringHelper *>(PSTR(string_literal))) + +// An inherited class for holding the result of a concatenation.  These +// result objects are assumed to be writable by subsequent concatenations. +class StringSumHelper; + +// The string class +class String +{ +	// use a function pointer to allow for "if (s)" without the +	// complications of an operator bool(). for more information, see: +	// http://www.artima.com/cppsource/safebool.html +	typedef void (String::*StringIfHelperType)() const; +	void StringIfHelper() const {} + +public: +	// constructors +	// creates a copy of the initial value. +	// if the initial value is null or invalid, or if memory allocation +	// fails, the string will be marked as invalid (i.e. "if (s)" will +	// be false). +	String(const char *cstr = ""); +	String(const String &str); +	String(const __FlashStringHelper *str); +       #if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__) +	String(String &&rval); +	String(StringSumHelper &&rval); +	#endif +	explicit String(char c); +	explicit String(unsigned char, unsigned char base=10); +	explicit String(int, unsigned char base=10); +	explicit String(unsigned int, unsigned char base=10); +	explicit String(long, unsigned char base=10); +	explicit String(unsigned long, unsigned char base=10); +	explicit String(float, unsigned char decimalPlaces=2); +	explicit String(double, unsigned char decimalPlaces=2); +	~String(void); + +	// memory management +	// return true on success, false on failure (in which case, the string +	// is left unchanged).  reserve(0), if successful, will validate an +	// invalid string (i.e., "if (s)" will be true afterwards) +	unsigned char reserve(unsigned int size); +	inline unsigned int length(void) const {return len;} + +	// creates a copy of the assigned value.  if the value is null or +	// invalid, or if the memory allocation fails, the string will be +	// marked as invalid ("if (s)" will be false). +	String & operator = (const String &rhs); +	String & operator = (const char *cstr); +	String & operator = (const __FlashStringHelper *str); +       #if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__) +	String & operator = (String &&rval); +	String & operator = (StringSumHelper &&rval); +	#endif + +	// concatenate (works w/ built-in types) + +	// returns true on success, false on failure (in which case, the string +	// is left unchanged).  if the argument is null or invalid, the +	// concatenation is considered unsuccessful. +	unsigned char concat(const String &str); +	unsigned char concat(const char *cstr); +	unsigned char concat(char c); +	unsigned char concat(unsigned char c); +	unsigned char concat(int num); +	unsigned char concat(unsigned int num); +	unsigned char concat(long num); +	unsigned char concat(unsigned long num); +	unsigned char concat(float num); +	unsigned char concat(double num); +	unsigned char concat(const __FlashStringHelper * str); + +	// if there's not enough memory for the concatenated value, the string +	// will be left unchanged (but this isn't signalled in any way) +	String & operator += (const String &rhs)	{concat(rhs); return (*this);} +	String & operator += (const char *cstr)		{concat(cstr); return (*this);} +	String & operator += (char c)			{concat(c); return (*this);} +	String & operator += (unsigned char num)		{concat(num); return (*this);} +	String & operator += (int num)			{concat(num); return (*this);} +	String & operator += (unsigned int num)		{concat(num); return (*this);} +	String & operator += (long num)			{concat(num); return (*this);} +	String & operator += (unsigned long num)	{concat(num); return (*this);} +	String & operator += (float num)		{concat(num); return (*this);} +	String & operator += (double num)		{concat(num); return (*this);} +	String & operator += (const __FlashStringHelper *str){concat(str); return (*this);} + +	friend StringSumHelper & operator + (const StringSumHelper &lhs, const String &rhs); +	friend StringSumHelper & operator + (const StringSumHelper &lhs, const char *cstr); +	friend StringSumHelper & operator + (const StringSumHelper &lhs, char c); +	friend StringSumHelper & operator + (const StringSumHelper &lhs, unsigned char num); +	friend StringSumHelper & operator + (const StringSumHelper &lhs, int num); +	friend StringSumHelper & operator + (const StringSumHelper &lhs, unsigned int num); +	friend StringSumHelper & operator + (const StringSumHelper &lhs, long num); +	friend StringSumHelper & operator + (const StringSumHelper &lhs, unsigned long num); +	friend StringSumHelper & operator + (const StringSumHelper &lhs, float num); +	friend StringSumHelper & operator + (const StringSumHelper &lhs, double num); +	friend StringSumHelper & operator + (const StringSumHelper &lhs, const __FlashStringHelper *rhs); + +	// comparison (only works w/ Strings and "strings") +	operator StringIfHelperType() const { return buffer ? &String::StringIfHelper : 0; } +	int compareTo(const String &s) const; +	unsigned char equals(const String &s) const; +	unsigned char equals(const char *cstr) const; +	unsigned char operator == (const String &rhs) const {return equals(rhs);} +	unsigned char operator == (const char *cstr) const {return equals(cstr);} +	unsigned char operator != (const String &rhs) const {return !equals(rhs);} +	unsigned char operator != (const char *cstr) const {return !equals(cstr);} +	unsigned char operator <  (const String &rhs) const; +	unsigned char operator >  (const String &rhs) const; +	unsigned char operator <= (const String &rhs) const; +	unsigned char operator >= (const String &rhs) const; +	unsigned char equalsIgnoreCase(const String &s) const; +	unsigned char startsWith( const String &prefix) const; +	unsigned char startsWith(const String &prefix, unsigned int offset) const; +	unsigned char endsWith(const String &suffix) const; + +	// character access +	char charAt(unsigned int index) const; +	void setCharAt(unsigned int index, char c); +	char operator [] (unsigned int index) const; +	char& operator [] (unsigned int index); +	void getBytes(unsigned char *buf, unsigned int bufsize, unsigned int index=0) const; +	void toCharArray(char *buf, unsigned int bufsize, unsigned int index=0) const +		{ getBytes((unsigned char *)buf, bufsize, index); } +	const char* c_str() const { return buffer; } +	char* begin() { return buffer; } +	char* end() { return buffer + length(); } +	const char* begin() const { return c_str(); } +	const char* end() const { return c_str() + length(); } + +	// search +	int indexOf( char ch ) const; +	int indexOf( char ch, unsigned int fromIndex ) const; +	int indexOf( const String &str ) const; +	int indexOf( const String &str, unsigned int fromIndex ) const; +	int lastIndexOf( char ch ) const; +	int lastIndexOf( char ch, unsigned int fromIndex ) const; +	int lastIndexOf( const String &str ) const; +	int lastIndexOf( const String &str, unsigned int fromIndex ) const; +	String substring( unsigned int beginIndex ) const { return substring(beginIndex, len); }; +	String substring( unsigned int beginIndex, unsigned int endIndex ) const; + +	// modification +	void replace(char find, char replace); +	void replace(const String& find, const String& replace); +	void remove(unsigned int index); +	void remove(unsigned int index, unsigned int count); +	void toLowerCase(void); +	void toUpperCase(void); +	void trim(void); + +	// parsing/conversion +	long toInt(void) const; +	float toFloat(void) const; +	double toDouble(void) const; + +protected: +	char *buffer;	        // the actual char array +	unsigned int capacity;  // the array length minus one (for the '\0') +	unsigned int len;       // the String length (not counting the '\0') +protected: +	void init(void); +	void invalidate(void); +	unsigned char changeBuffer(unsigned int maxStrLen); +	unsigned char concat(const char *cstr, unsigned int length); + +	// copy and move +	String & copy(const char *cstr, unsigned int length); +	String & copy(const __FlashStringHelper *pstr, unsigned int length); +       #if __cplusplus >= 201103L || defined(__GXX_EXPERIMENTAL_CXX0X__) +	void move(String &rhs); +	#endif +}; + +class StringSumHelper : public String +{ +public: +	StringSumHelper(const String &s) : String(s) {} +	StringSumHelper(const char *p) : String(p) {} +	StringSumHelper(char c) : String(c) {} +	StringSumHelper(unsigned char num) : String(num) {} +	StringSumHelper(int num) : String(num) {} +	StringSumHelper(unsigned int num) : String(num) {} +	StringSumHelper(long num) : String(num) {} +	StringSumHelper(unsigned long num) : String(num) {} +	StringSumHelper(float num) : String(num) {} +	StringSumHelper(double num) : String(num) {} +}; + +#endif  // __cplusplus +#endif  // String_class_h diff --git a/cores/xinput/abi.cpp b/cores/xinput/abi.cpp new file mode 100644 index 0000000..6e1b0f8 --- /dev/null +++ b/cores/xinput/abi.cpp @@ -0,0 +1,36 @@ +/* +  Copyright (c) 2014 Arduino.  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 +*/ + +#include <stdlib.h> + +extern "C" void __cxa_pure_virtual(void) __attribute__ ((__noreturn__)); +extern "C" void __cxa_deleted_virtual(void) __attribute__ ((__noreturn__)); + +namespace std { +  [[gnu::weak, noreturn]] void terminate() { +    abort(); +  } +} + +void __cxa_pure_virtual(void) { +  std::terminate(); +} + +void __cxa_deleted_virtual(void) { +  std::terminate(); +} diff --git a/cores/xinput/binary.h b/cores/xinput/binary.h new file mode 100644 index 0000000..aec4c73 --- /dev/null +++ b/cores/xinput/binary.h @@ -0,0 +1,534 @@ +/* +  binary.h - Definitions for binary constants +  Copyright (c) 2006 David A. Mellis.  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 +*/ + +#ifndef Binary_h +#define Binary_h + +#define B0 0 +#define B00 0 +#define B000 0 +#define B0000 0 +#define B00000 0 +#define B000000 0 +#define B0000000 0 +#define B00000000 0 +#define B1 1 +#define B01 1 +#define B001 1 +#define B0001 1 +#define B00001 1 +#define B000001 1 +#define B0000001 1 +#define B00000001 1 +#define B10 2 +#define B010 2 +#define B0010 2 +#define B00010 2 +#define B000010 2 +#define B0000010 2 +#define B00000010 2 +#define B11 3 +#define B011 3 +#define B0011 3 +#define B00011 3 +#define B000011 3 +#define B0000011 3 +#define B00000011 3 +#define B100 4 +#define B0100 4 +#define B00100 4 +#define B000100 4 +#define B0000100 4 +#define B00000100 4 +#define B101 5 +#define B0101 5 +#define B00101 5 +#define B000101 5 +#define B0000101 5 +#define B00000101 5 +#define B110 6 +#define B0110 6 +#define B00110 6 +#define B000110 6 +#define B0000110 6 +#define B00000110 6 +#define B111 7 +#define B0111 7 +#define B00111 7 +#define B000111 7 +#define B0000111 7 +#define B00000111 7 +#define B1000 8 +#define B01000 8 +#define B001000 8 +#define B0001000 8 +#define B00001000 8 +#define B1001 9 +#define B01001 9 +#define B001001 9 +#define B0001001 9 +#define B00001001 9 +#define B1010 10 +#define B01010 10 +#define B001010 10 +#define B0001010 10 +#define B00001010 10 +#define B1011 11 +#define B01011 11 +#define B001011 11 +#define B0001011 11 +#define B00001011 11 +#define B1100 12 +#define B01100 12 +#define B001100 12 +#define B0001100 12 +#define B00001100 12 +#define B1101 13 +#define B01101 13 +#define B001101 13 +#define B0001101 13 +#define B00001101 13 +#define B1110 14 +#define B01110 14 +#define B001110 14 +#define B0001110 14 +#define B00001110 14 +#define B1111 15 +#define B01111 15 +#define B001111 15 +#define B0001111 15 +#define B00001111 15 +#define B10000 16 +#define B010000 16 +#define B0010000 16 +#define B00010000 16 +#define B10001 17 +#define B010001 17 +#define B0010001 17 +#define B00010001 17 +#define B10010 18 +#define B010010 18 +#define B0010010 18 +#define B00010010 18 +#define B10011 19 +#define B010011 19 +#define B0010011 19 +#define B00010011 19 +#define B10100 20 +#define B010100 20 +#define B0010100 20 +#define B00010100 20 +#define B10101 21 +#define B010101 21 +#define B0010101 21 +#define B00010101 21 +#define B10110 22 +#define B010110 22 +#define B0010110 22 +#define B00010110 22 +#define B10111 23 +#define B010111 23 +#define B0010111 23 +#define B00010111 23 +#define B11000 24 +#define B011000 24 +#define B0011000 24 +#define B00011000 24 +#define B11001 25 +#define B011001 25 +#define B0011001 25 +#define B00011001 25 +#define B11010 26 +#define B011010 26 +#define B0011010 26 +#define B00011010 26 +#define B11011 27 +#define B011011 27 +#define B0011011 27 +#define B00011011 27 +#define B11100 28 +#define B011100 28 +#define B0011100 28 +#define B00011100 28 +#define B11101 29 +#define B011101 29 +#define B0011101 29 +#define B00011101 29 +#define B11110 30 +#define B011110 30 +#define B0011110 30 +#define B00011110 30 +#define B11111 31 +#define B011111 31 +#define B0011111 31 +#define B00011111 31 +#define B100000 32 +#define B0100000 32 +#define B00100000 32 +#define B100001 33 +#define B0100001 33 +#define B00100001 33 +#define B100010 34 +#define B0100010 34 +#define B00100010 34 +#define B100011 35 +#define B0100011 35 +#define B00100011 35 +#define B100100 36 +#define B0100100 36 +#define B00100100 36 +#define B100101 37 +#define B0100101 37 +#define B00100101 37 +#define B100110 38 +#define B0100110 38 +#define B00100110 38 +#define B100111 39 +#define B0100111 39 +#define B00100111 39 +#define B101000 40 +#define B0101000 40 +#define B00101000 40 +#define B101001 41 +#define B0101001 41 +#define B00101001 41 +#define B101010 42 +#define B0101010 42 +#define B00101010 42 +#define B101011 43 +#define B0101011 43 +#define B00101011 43 +#define B101100 44 +#define B0101100 44 +#define B00101100 44 +#define B101101 45 +#define B0101101 45 +#define B00101101 45 +#define B101110 46 +#define B0101110 46 +#define B00101110 46 +#define B101111 47 +#define B0101111 47 +#define B00101111 47 +#define B110000 48 +#define B0110000 48 +#define B00110000 48 +#define B110001 49 +#define B0110001 49 +#define B00110001 49 +#define B110010 50 +#define B0110010 50 +#define B00110010 50 +#define B110011 51 +#define B0110011 51 +#define B00110011 51 +#define B110100 52 +#define B0110100 52 +#define B00110100 52 +#define B110101 53 +#define B0110101 53 +#define B00110101 53 +#define B110110 54 +#define B0110110 54 +#define B00110110 54 +#define B110111 55 +#define B0110111 55 +#define B00110111 55 +#define B111000 56 +#define B0111000 56 +#define B00111000 56 +#define B111001 57 +#define B0111001 57 +#define B00111001 57 +#define B111010 58 +#define B0111010 58 +#define B00111010 58 +#define B111011 59 +#define B0111011 59 +#define B00111011 59 +#define B111100 60 +#define B0111100 60 +#define B00111100 60 +#define B111101 61 +#define B0111101 61 +#define B00111101 61 +#define B111110 62 +#define B0111110 62 +#define B00111110 62 +#define B111111 63 +#define B0111111 63 +#define B00111111 63 +#define B1000000 64 +#define B01000000 64 +#define B1000001 65 +#define B01000001 65 +#define B1000010 66 +#define B01000010 66 +#define B1000011 67 +#define B01000011 67 +#define B1000100 68 +#define B01000100 68 +#define B1000101 69 +#define B01000101 69 +#define B1000110 70 +#define B01000110 70 +#define B1000111 71 +#define B01000111 71 +#define B1001000 72 +#define B01001000 72 +#define B1001001 73 +#define B01001001 73 +#define B1001010 74 +#define B01001010 74 +#define B1001011 75 +#define B01001011 75 +#define B1001100 76 +#define B01001100 76 +#define B1001101 77 +#define B01001101 77 +#define B1001110 78 +#define B01001110 78 +#define B1001111 79 +#define B01001111 79 +#define B1010000 80 +#define B01010000 80 +#define B1010001 81 +#define B01010001 81 +#define B1010010 82 +#define B01010010 82 +#define B1010011 83 +#define B01010011 83 +#define B1010100 84 +#define B01010100 84 +#define B1010101 85 +#define B01010101 85 +#define B1010110 86 +#define B01010110 86 +#define B1010111 87 +#define B01010111 87 +#define B1011000 88 +#define B01011000 88 +#define B1011001 89 +#define B01011001 89 +#define B1011010 90 +#define B01011010 90 +#define B1011011 91 +#define B01011011 91 +#define B1011100 92 +#define B01011100 92 +#define B1011101 93 +#define B01011101 93 +#define B1011110 94 +#define B01011110 94 +#define B1011111 95 +#define B01011111 95 +#define B1100000 96 +#define B01100000 96 +#define B1100001 97 +#define B01100001 97 +#define B1100010 98 +#define B01100010 98 +#define B1100011 99 +#define B01100011 99 +#define B1100100 100 +#define B01100100 100 +#define B1100101 101 +#define B01100101 101 +#define B1100110 102 +#define B01100110 102 +#define B1100111 103 +#define B01100111 103 +#define B1101000 104 +#define B01101000 104 +#define B1101001 105 +#define B01101001 105 +#define B1101010 106 +#define B01101010 106 +#define B1101011 107 +#define B01101011 107 +#define B1101100 108 +#define B01101100 108 +#define B1101101 109 +#define B01101101 109 +#define B1101110 110 +#define B01101110 110 +#define B1101111 111 +#define B01101111 111 +#define B1110000 112 +#define B01110000 112 +#define B1110001 113 +#define B01110001 113 +#define B1110010 114 +#define B01110010 114 +#define B1110011 115 +#define B01110011 115 +#define B1110100 116 +#define B01110100 116 +#define B1110101 117 +#define B01110101 117 +#define B1110110 118 +#define B01110110 118 +#define B1110111 119 +#define B01110111 119 +#define B1111000 120 +#define B01111000 120 +#define B1111001 121 +#define B01111001 121 +#define B1111010 122 +#define B01111010 122 +#define B1111011 123 +#define B01111011 123 +#define B1111100 124 +#define B01111100 124 +#define B1111101 125 +#define B01111101 125 +#define B1111110 126 +#define B01111110 126 +#define B1111111 127 +#define B01111111 127 +#define B10000000 128 +#define B10000001 129 +#define B10000010 130 +#define B10000011 131 +#define B10000100 132 +#define B10000101 133 +#define B10000110 134 +#define B10000111 135 +#define B10001000 136 +#define B10001001 137 +#define B10001010 138 +#define B10001011 139 +#define B10001100 140 +#define B10001101 141 +#define B10001110 142 +#define B10001111 143 +#define B10010000 144 +#define B10010001 145 +#define B10010010 146 +#define B10010011 147 +#define B10010100 148 +#define B10010101 149 +#define B10010110 150 +#define B10010111 151 +#define B10011000 152 +#define B10011001 153 +#define B10011010 154 +#define B10011011 155 +#define B10011100 156 +#define B10011101 157 +#define B10011110 158 +#define B10011111 159 +#define B10100000 160 +#define B10100001 161 +#define B10100010 162 +#define B10100011 163 +#define B10100100 164 +#define B10100101 165 +#define B10100110 166 +#define B10100111 167 +#define B10101000 168 +#define B10101001 169 +#define B10101010 170 +#define B10101011 171 +#define B10101100 172 +#define B10101101 173 +#define B10101110 174 +#define B10101111 175 +#define B10110000 176 +#define B10110001 177 +#define B10110010 178 +#define B10110011 179 +#define B10110100 180 +#define B10110101 181 +#define B10110110 182 +#define B10110111 183 +#define B10111000 184 +#define B10111001 185 +#define B10111010 186 +#define B10111011 187 +#define B10111100 188 +#define B10111101 189 +#define B10111110 190 +#define B10111111 191 +#define B11000000 192 +#define B11000001 193 +#define B11000010 194 +#define B11000011 195 +#define B11000100 196 +#define B11000101 197 +#define B11000110 198 +#define B11000111 199 +#define B11001000 200 +#define B11001001 201 +#define B11001010 202 +#define B11001011 203 +#define B11001100 204 +#define B11001101 205 +#define B11001110 206 +#define B11001111 207 +#define B11010000 208 +#define B11010001 209 +#define B11010010 210 +#define B11010011 211 +#define B11010100 212 +#define B11010101 213 +#define B11010110 214 +#define B11010111 215 +#define B11011000 216 +#define B11011001 217 +#define B11011010 218 +#define B11011011 219 +#define B11011100 220 +#define B11011101 221 +#define B11011110 222 +#define B11011111 223 +#define B11100000 224 +#define B11100001 225 +#define B11100010 226 +#define B11100011 227 +#define B11100100 228 +#define B11100101 229 +#define B11100110 230 +#define B11100111 231 +#define B11101000 232 +#define B11101001 233 +#define B11101010 234 +#define B11101011 235 +#define B11101100 236 +#define B11101101 237 +#define B11101110 238 +#define B11101111 239 +#define B11110000 240 +#define B11110001 241 +#define B11110010 242 +#define B11110011 243 +#define B11110100 244 +#define B11110101 245 +#define B11110110 246 +#define B11110111 247 +#define B11111000 248 +#define B11111001 249 +#define B11111010 250 +#define B11111011 251 +#define B11111100 252 +#define B11111101 253 +#define B11111110 254 +#define B11111111 255 + +#endif diff --git a/cores/xinput/hooks.c b/cores/xinput/hooks.c new file mode 100644 index 0000000..641eabc --- /dev/null +++ b/cores/xinput/hooks.c @@ -0,0 +1,31 @@ +/* +  Copyright (c) 2012 Arduino.  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 +*/ + +/** + * Empty yield() hook. + * + * This function is intended to be used by library writers to build + * libraries or sketches that supports cooperative threads. + * + * Its defined as a weak symbol and it can be redefined to implement a + * real cooperative scheduler. + */ +static void __empty() { +	// Empty +} +void yield(void) __attribute__ ((weak, alias("__empty"))); diff --git a/cores/xinput/main.cpp b/cores/xinput/main.cpp new file mode 100644 index 0000000..434cd40 --- /dev/null +++ b/cores/xinput/main.cpp @@ -0,0 +1,52 @@ +/* +  main.cpp - Main loop for Arduino sketches +  Copyright (c) 2005-2013 Arduino Team.  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 +*/ + +#include <Arduino.h> + +// Declared weak in Arduino.h to allow user redefinitions. +int atexit(void (* /*func*/ )()) { return 0; } + +// Weak empty variant initialization function. +// May be redefined by variant files. +void initVariant() __attribute__((weak)); +void initVariant() { } + +void setupUSB() __attribute__((weak)); +void setupUSB() { } + +int main(void) +{ +	init(); + +	initVariant(); + +#if defined(USBCON) +	USBDevice.attach(); +#endif +	 +	setup(); +     +	for (;;) { +		loop(); +		if (serialEventRun) serialEventRun(); +	} +         +	return 0; +} + diff --git a/cores/xinput/new b/cores/xinput/new new file mode 100644 index 0000000..8cf2103 --- /dev/null +++ b/cores/xinput/new @@ -0,0 +1,66 @@ +/* +  Copyright (c) 2014 Arduino.  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 +*/ + +#ifndef NEW_H +#define NEW_H + +#include <stdlib.h> + +namespace std { +  struct nothrow_t {}; +  extern const nothrow_t nothrow; + +  // These are not actually implemented, to prevent overhead and +  // complexity. They are still declared to allow implementing +  // them in user code if needed. +  typedef void (*new_handler)(); +  new_handler set_new_handler(new_handler new_p) noexcept; +  new_handler get_new_handler() noexcept; + +  // This is normally declared in various headers that we do not have +  // available, so just define it here. We could also use ::size_t +  // below, but then anyone including <new> can no longer assume +  // std::size_t is available. +  using size_t = ::size_t; +} // namespace std + +[[gnu::weak]] void * operator new(std::size_t size); +[[gnu::weak]] void * operator new[](std::size_t size); + +[[gnu::weak]] void * operator new(std::size_t size, const std::nothrow_t tag) noexcept; +[[gnu::weak]] void * operator new[](std::size_t size, const std::nothrow_t& tag) noexcept; + +void * operator new(std::size_t size, void *place) noexcept; +void * operator new[](std::size_t size, void *place) noexcept; + +[[gnu::weak]] void operator delete(void * ptr) noexcept; +[[gnu::weak]] void operator delete[](void * ptr) noexcept; + +#if __cplusplus >= 201402L +[[gnu::weak]] void operator delete(void* ptr, std::size_t size) noexcept; +[[gnu::weak]] void operator delete[](void * ptr, std::size_t size) noexcept; +#endif // __cplusplus >= 201402L + +[[gnu::weak]] void operator delete(void* ptr, const std::nothrow_t& tag) noexcept; +[[gnu::weak]] void operator delete[](void* ptr, const std::nothrow_t& tag) noexcept; + +void operator delete(void* ptr, void* place) noexcept; +void operator delete[](void* ptr, void* place) noexcept; + +#endif + diff --git a/cores/xinput/new.cpp b/cores/xinput/new.cpp new file mode 100644 index 0000000..7ca4931 --- /dev/null +++ b/cores/xinput/new.cpp @@ -0,0 +1,117 @@ +/* +  Copyright (c) 2014 Arduino.  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 +*/ + +#include "new.h" + +// The C++ spec dictates that allocation failure should cause the +// (non-nothrow version of the) operator new to throw an exception. +// Since we expect to have exceptions disabled, it would be more +// appropriate (and probably standards-compliant) to terminate instead. +// Historically failure causes null to be returned, but this define +// allows switching to more robust terminating behaviour (that might +// become the default at some point in the future). Note that any code +// that wants null to be returned can (and should) use the nothrow +// versions of the new statement anyway and is unaffected by this. +// #define NEW_TERMINATES_ON_FAILURE + +namespace std { +  // Defined in abi.cpp +  void terminate(); + +  const nothrow_t nothrow; +} + +static void * new_helper(std::size_t size) { +  // Even zero-sized allocations should return a unique pointer, but +  // malloc does not guarantee this +  if (size == 0) +    size = 1; +  return malloc(size); +} + +void * operator new(std::size_t size) { +  void *res = new_helper(size); +#if defined(NEW_TERMINATES_ON_FAILURE) +  if (!res) +    std::terminate(); +#endif +  return res; +} +void * operator new[](std::size_t size) { +  return operator new(size); +} + +void * operator new(std::size_t size, const std::nothrow_t tag) noexcept { +#if defined(NEW_TERMINATES_ON_FAILURE) +  // Cannot call throwing operator new as standard suggests, so call +  // new_helper directly then +  return new_helper(size); +#else +  return operator new(size); +#endif +} +void * operator new[](std::size_t size, const std::nothrow_t& tag) noexcept { +#if defined(NEW_TERMINATES_ON_FAILURE) +  // Cannot call throwing operator new[] as standard suggests, so call +  // malloc directly then +  return new_helper(size); +#else +  return operator new[](size); +#endif +} + +void * operator new(std::size_t size, void *place) noexcept { +  // Nothing to do +  (void)size; // unused +  return place; +} +void * operator new[](std::size_t size, void *place) noexcept { +  return operator new(size, place); +} + +void operator delete(void * ptr) noexcept { +  free(ptr); +} +void operator delete[](void * ptr) noexcept { +  operator delete(ptr); +} + +#if __cplusplus >= 201402L +void operator delete(void* ptr, std::size_t size) noexcept { +  operator delete(ptr); +} +void operator delete[](void * ptr, std::size_t size) noexcept { +  operator delete[](ptr); +} +#endif // __cplusplus >= 201402L + +void operator delete(void* ptr, const std::nothrow_t& tag) noexcept { +  operator delete(ptr); +} +void operator delete[](void* ptr, const std::nothrow_t& tag) noexcept { +  operator delete[](ptr); +} + +void operator delete(void* ptr, void* place) noexcept { +  (void)ptr; (void)place; // unused +  // Nothing to do +} +void operator delete[](void* ptr, void* place) noexcept { +  (void)ptr; (void)place; // unused +  // Nothing to do +} diff --git a/cores/xinput/new.h b/cores/xinput/new.h new file mode 100644 index 0000000..d529853 --- /dev/null +++ b/cores/xinput/new.h @@ -0,0 +1,3 @@ +// This file originally used a non-standard name for this Arduino core +// only, so still expose the old new.h name for compatibility. +#include "new" diff --git a/cores/xinput/wiring.c b/cores/xinput/wiring.c new file mode 100644 index 0000000..8caf455 --- /dev/null +++ b/cores/xinput/wiring.c @@ -0,0 +1,392 @@ +/* +  wiring.c - Partial implementation of the Wiring API for the ATmega8. +  Part of Arduino - http://www.arduino.cc/ + +  Copyright (c) 2005-2006 David A. Mellis + +  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., 59 Temple Place, Suite 330, +  Boston, MA  02111-1307  USA +*/ + +#include "wiring_private.h" + +// the prescaler is set so that timer0 ticks every 64 clock cycles, and the +// the overflow handler is called every 256 ticks. +#define MICROSECONDS_PER_TIMER0_OVERFLOW (clockCyclesToMicroseconds(64 * 256)) + +// the whole number of milliseconds per timer0 overflow +#define MILLIS_INC (MICROSECONDS_PER_TIMER0_OVERFLOW / 1000) + +// the fractional number of milliseconds per timer0 overflow. we shift right +// by three to fit these numbers into a byte. (for the clock speeds we care +// about - 8 and 16 MHz - this doesn't lose precision.) +#define FRACT_INC ((MICROSECONDS_PER_TIMER0_OVERFLOW % 1000) >> 3) +#define FRACT_MAX (1000 >> 3) + +volatile unsigned long timer0_overflow_count = 0; +volatile unsigned long timer0_millis = 0; +static unsigned char timer0_fract = 0; + +#if defined(TIM0_OVF_vect) +ISR(TIM0_OVF_vect) +#else +ISR(TIMER0_OVF_vect) +#endif +{ +	// copy these to local variables so they can be stored in registers +	// (volatile variables must be read from memory on every access) +	unsigned long m = timer0_millis; +	unsigned char f = timer0_fract; + +	m += MILLIS_INC; +	f += FRACT_INC; +	if (f >= FRACT_MAX) { +		f -= FRACT_MAX; +		m += 1; +	} + +	timer0_fract = f; +	timer0_millis = m; +	timer0_overflow_count++; +} + +unsigned long millis() +{ +	unsigned long m; +	uint8_t oldSREG = SREG; + +	// disable interrupts while we read timer0_millis or we might get an +	// inconsistent value (e.g. in the middle of a write to timer0_millis) +	cli(); +	m = timer0_millis; +	SREG = oldSREG; + +	return m; +} + +unsigned long micros() { +	unsigned long m; +	uint8_t oldSREG = SREG, t; +	 +	cli(); +	m = timer0_overflow_count; +#if defined(TCNT0) +	t = TCNT0; +#elif defined(TCNT0L) +	t = TCNT0L; +#else +	#error TIMER 0 not defined +#endif + +#ifdef TIFR0 +	if ((TIFR0 & _BV(TOV0)) && (t < 255)) +		m++; +#else +	if ((TIFR & _BV(TOV0)) && (t < 255)) +		m++; +#endif + +	SREG = oldSREG; +	 +	return ((m << 8) + t) * (64 / clockCyclesPerMicrosecond()); +} + +void delay(unsigned long ms) +{ +	uint32_t start = micros(); + +	while (ms > 0) { +		yield(); +		while ( ms > 0 && (micros() - start) >= 1000) { +			ms--; +			start += 1000; +		} +	} +} + +/* Delay for the given number of microseconds.  Assumes a 1, 8, 12, 16, 20 or 24 MHz clock. */ +void delayMicroseconds(unsigned int us) +{ +	// call = 4 cycles + 2 to 4 cycles to init us(2 for constant delay, 4 for variable) + +	// calling avrlib's delay_us() function with low values (e.g. 1 or +	// 2 microseconds) gives delays longer than desired. +	//delay_us(us); +#if F_CPU >= 24000000L +	// for the 24 MHz clock for the adventurous ones trying to overclock + +	// zero delay fix +	if (!us) return; //  = 3 cycles, (4 when true) + +	// the following loop takes a 1/6 of a microsecond (4 cycles) +	// per iteration, so execute it six times for each microsecond of +	// delay requested. +	us *= 6; // x6 us, = 7 cycles + +	// account for the time taken in the preceding commands. +	// we just burned 22 (24) cycles above, remove 5, (5*4=20) +	// us is at least 6 so we can subtract 5 +	us -= 5; //=2 cycles + +#elif F_CPU >= 20000000L +	// for the 20 MHz clock on rare Arduino boards + +	// for a one-microsecond delay, simply return.  the overhead +	// of the function call takes 18 (20) cycles, which is 1us +	__asm__ __volatile__ ( +		"nop" "\n\t" +		"nop" "\n\t" +		"nop" "\n\t" +		"nop"); //just waiting 4 cycles +	if (us <= 1) return; //  = 3 cycles, (4 when true) + +	// the following loop takes a 1/5 of a microsecond (4 cycles) +	// per iteration, so execute it five times for each microsecond of +	// delay requested. +	us = (us << 2) + us; // x5 us, = 7 cycles + +	// account for the time taken in the preceding commands. +	// we just burned 26 (28) cycles above, remove 7, (7*4=28) +	// us is at least 10 so we can subtract 7 +	us -= 7; // 2 cycles + +#elif F_CPU >= 16000000L +	// for the 16 MHz clock on most Arduino boards + +	// for a one-microsecond delay, simply return.  the overhead +	// of the function call takes 14 (16) cycles, which is 1us +	if (us <= 1) return; //  = 3 cycles, (4 when true) + +	// the following loop takes 1/4 of a microsecond (4 cycles) +	// per iteration, so execute it four times for each microsecond of +	// delay requested. +	us <<= 2; // x4 us, = 4 cycles + +	// account for the time taken in the preceding commands. +	// we just burned 19 (21) cycles above, remove 5, (5*4=20) +	// us is at least 8 so we can subtract 5 +	us -= 5; // = 2 cycles, + +#elif F_CPU >= 12000000L +	// for the 12 MHz clock if somebody is working with USB + +	// for a 1 microsecond delay, simply return.  the overhead +	// of the function call takes 14 (16) cycles, which is 1.5us +	if (us <= 1) return; //  = 3 cycles, (4 when true) + +	// the following loop takes 1/3 of a microsecond (4 cycles) +	// per iteration, so execute it three times for each microsecond of +	// delay requested. +	us = (us << 1) + us; // x3 us, = 5 cycles + +	// account for the time taken in the preceding commands. +	// we just burned 20 (22) cycles above, remove 5, (5*4=20) +	// us is at least 6 so we can subtract 5 +	us -= 5; //2 cycles + +#elif F_CPU >= 8000000L +	// for the 8 MHz internal clock + +	// for a 1 and 2 microsecond delay, simply return.  the overhead +	// of the function call takes 14 (16) cycles, which is 2us +	if (us <= 2) return; //  = 3 cycles, (4 when true) + +	// the following loop takes 1/2 of a microsecond (4 cycles) +	// per iteration, so execute it twice for each microsecond of +	// delay requested. +	us <<= 1; //x2 us, = 2 cycles + +	// account for the time taken in the preceding commands. +	// we just burned 17 (19) cycles above, remove 4, (4*4=16) +	// us is at least 6 so we can subtract 4 +	us -= 4; // = 2 cycles + +#else +	// for the 1 MHz internal clock (default settings for common Atmega microcontrollers) + +	// the overhead of the function calls is 14 (16) cycles +	if (us <= 16) return; //= 3 cycles, (4 when true) +	if (us <= 25) return; //= 3 cycles, (4 when true), (must be at least 25 if we want to subtract 22) + +	// compensate for the time taken by the preceding and next commands (about 22 cycles) +	us -= 22; // = 2 cycles +	// the following loop takes 4 microseconds (4 cycles) +	// per iteration, so execute it us/4 times +	// us is at least 4, divided by 4 gives us 1 (no zero delay bug) +	us >>= 2; // us div 4, = 4 cycles +	 + +#endif + +	// busy wait +	__asm__ __volatile__ ( +		"1: sbiw %0,1" "\n\t" // 2 cycles +		"brne 1b" : "=w" (us) : "0" (us) // 2 cycles +	); +	// return = 4 cycles +} + +void init() +{ +	// this needs to be called before setup() or some functions won't +	// work there +	sei(); +	 +	// on the ATmega168, timer 0 is also used for fast hardware pwm +	// (using phase-correct PWM would mean that timer 0 overflowed half as often +	// resulting in different millis() behavior on the ATmega8 and ATmega168) +#if defined(TCCR0A) && defined(WGM01) +	sbi(TCCR0A, WGM01); +	sbi(TCCR0A, WGM00); +#endif + +	// set timer 0 prescale factor to 64 +#if defined(__AVR_ATmega128__) +	// CPU specific: different values for the ATmega128 +	sbi(TCCR0, CS02); +#elif defined(TCCR0) && defined(CS01) && defined(CS00) +	// this combination is for the standard atmega8 +	sbi(TCCR0, CS01); +	sbi(TCCR0, CS00); +#elif defined(TCCR0B) && defined(CS01) && defined(CS00) +	// this combination is for the standard 168/328/1280/2560 +	sbi(TCCR0B, CS01); +	sbi(TCCR0B, CS00); +#elif defined(TCCR0A) && defined(CS01) && defined(CS00) +	// this combination is for the __AVR_ATmega645__ series +	sbi(TCCR0A, CS01); +	sbi(TCCR0A, CS00); +#else +	#error Timer 0 prescale factor 64 not set correctly +#endif + +	// enable timer 0 overflow interrupt +#if defined(TIMSK) && defined(TOIE0) +	sbi(TIMSK, TOIE0); +#elif defined(TIMSK0) && defined(TOIE0) +	sbi(TIMSK0, TOIE0); +#else +	#error	Timer 0 overflow interrupt not set correctly +#endif + +	// timers 1 and 2 are used for phase-correct hardware pwm +	// this is better for motors as it ensures an even waveform +	// note, however, that fast pwm mode can achieve a frequency of up +	// 8 MHz (with a 16 MHz clock) at 50% duty cycle + +#if defined(TCCR1B) && defined(CS11) && defined(CS10) +	TCCR1B = 0; + +	// set timer 1 prescale factor to 64 +	sbi(TCCR1B, CS11); +#if F_CPU >= 8000000L +	sbi(TCCR1B, CS10); +#endif +#elif defined(TCCR1) && defined(CS11) && defined(CS10) +	sbi(TCCR1, CS11); +#if F_CPU >= 8000000L +	sbi(TCCR1, CS10); +#endif +#endif +	// put timer 1 in 8-bit phase correct pwm mode +#if defined(TCCR1A) && defined(WGM10) +	sbi(TCCR1A, WGM10); +#endif + +	// set timer 2 prescale factor to 64 +#if defined(TCCR2) && defined(CS22) +	sbi(TCCR2, CS22); +#elif defined(TCCR2B) && defined(CS22) +	sbi(TCCR2B, CS22); +//#else +	// Timer 2 not finished (may not be present on this CPU) +#endif + +	// configure timer 2 for phase correct pwm (8-bit) +#if defined(TCCR2) && defined(WGM20) +	sbi(TCCR2, WGM20); +#elif defined(TCCR2A) && defined(WGM20) +	sbi(TCCR2A, WGM20); +//#else +	// Timer 2 not finished (may not be present on this CPU) +#endif + +#if defined(TCCR3B) && defined(CS31) && defined(WGM30) +	sbi(TCCR3B, CS31);		// set timer 3 prescale factor to 64 +	sbi(TCCR3B, CS30); +	sbi(TCCR3A, WGM30);		// put timer 3 in 8-bit phase correct pwm mode +#endif + +#if defined(TCCR4A) && defined(TCCR4B) && defined(TCCR4D) /* beginning of timer4 block for 32U4 and similar */ +	sbi(TCCR4B, CS42);		// set timer4 prescale factor to 64 +	sbi(TCCR4B, CS41); +	sbi(TCCR4B, CS40); +	sbi(TCCR4D, WGM40);		// put timer 4 in phase- and frequency-correct PWM mode	 +	sbi(TCCR4A, PWM4A);		// enable PWM mode for comparator OCR4A +	sbi(TCCR4C, PWM4D);		// enable PWM mode for comparator OCR4D +#else /* beginning of timer4 block for ATMEGA1280 and ATMEGA2560 */ +#if defined(TCCR4B) && defined(CS41) && defined(WGM40) +	sbi(TCCR4B, CS41);		// set timer 4 prescale factor to 64 +	sbi(TCCR4B, CS40); +	sbi(TCCR4A, WGM40);		// put timer 4 in 8-bit phase correct pwm mode +#endif +#endif /* end timer4 block for ATMEGA1280/2560 and similar */	 + +#if defined(TCCR5B) && defined(CS51) && defined(WGM50) +	sbi(TCCR5B, CS51);		// set timer 5 prescale factor to 64 +	sbi(TCCR5B, CS50); +	sbi(TCCR5A, WGM50);		// put timer 5 in 8-bit phase correct pwm mode +#endif + +#if defined(ADCSRA) +	// set a2d prescaler so we are inside the desired 50-200 KHz range. +	#if F_CPU >= 16000000 // 16 MHz / 128 = 125 KHz +		sbi(ADCSRA, ADPS2); +		sbi(ADCSRA, ADPS1); +		sbi(ADCSRA, ADPS0); +	#elif F_CPU >= 8000000 // 8 MHz / 64 = 125 KHz +		sbi(ADCSRA, ADPS2); +		sbi(ADCSRA, ADPS1); +		cbi(ADCSRA, ADPS0); +	#elif F_CPU >= 4000000 // 4 MHz / 32 = 125 KHz +		sbi(ADCSRA, ADPS2); +		cbi(ADCSRA, ADPS1); +		sbi(ADCSRA, ADPS0); +	#elif F_CPU >= 2000000 // 2 MHz / 16 = 125 KHz +		sbi(ADCSRA, ADPS2); +		cbi(ADCSRA, ADPS1); +		cbi(ADCSRA, ADPS0); +	#elif F_CPU >= 1000000 // 1 MHz / 8 = 125 KHz +		cbi(ADCSRA, ADPS2); +		sbi(ADCSRA, ADPS1); +		sbi(ADCSRA, ADPS0); +	#else // 128 kHz / 2 = 64 KHz -> This is the closest you can get, the prescaler is 2 +		cbi(ADCSRA, ADPS2); +		cbi(ADCSRA, ADPS1); +		sbi(ADCSRA, ADPS0); +	#endif +	// enable a2d conversions +	sbi(ADCSRA, ADEN); +#endif + +	// the bootloader connects pins 0 and 1 to the USART; disconnect them +	// here so they can be used as normal digital i/o; they will be +	// reconnected in Serial.begin() +#if defined(UCSRB) +	UCSRB = 0; +#elif defined(UCSR0B) +	UCSR0B = 0; +#endif +} diff --git a/cores/xinput/wiring_analog.c b/cores/xinput/wiring_analog.c new file mode 100644 index 0000000..0de64f7 --- /dev/null +++ b/cores/xinput/wiring_analog.c @@ -0,0 +1,286 @@ +/* +  wiring_analog.c - analog input and output +  Part of Arduino - http://www.arduino.cc/ + +  Copyright (c) 2005-2006 David A. Mellis + +  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., 59 Temple Place, Suite 330, +  Boston, MA  02111-1307  USA + +  Modified 28 September 2010 by Mark Sproul +*/ + +#include "wiring_private.h" +#include "pins_arduino.h" + +uint8_t analog_reference = DEFAULT; + +void analogReference(uint8_t mode) +{ +	// can't actually set the register here because the default setting +	// will connect AVCC and the AREF pin, which would cause a short if +	// there's something connected to AREF. +	analog_reference = mode; +} + +int analogRead(uint8_t pin) +{ + +#if defined(analogPinToChannel) +#if defined(__AVR_ATmega32U4__) +	if (pin >= 18) pin -= 18; // allow for channel or pin numbers +#endif +	pin = analogPinToChannel(pin); +#elif defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__) +	if (pin >= 54) pin -= 54; // allow for channel or pin numbers +#elif defined(__AVR_ATmega32U4__) +	if (pin >= 18) pin -= 18; // allow for channel or pin numbers +#elif defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__) || defined(__AVR_ATmega644__) || defined(__AVR_ATmega644A__) || defined(__AVR_ATmega644P__) || defined(__AVR_ATmega644PA__) +	if (pin >= 24) pin -= 24; // allow for channel or pin numbers +#else +	if (pin >= 14) pin -= 14; // allow for channel or pin numbers +#endif + +#if defined(ADCSRB) && defined(MUX5) +	// the MUX5 bit of ADCSRB selects whether we're reading from channels +	// 0 to 7 (MUX5 low) or 8 to 15 (MUX5 high). +	ADCSRB = (ADCSRB & ~(1 << MUX5)) | (((pin >> 3) & 0x01) << MUX5); +#endif +   +	// set the analog reference (high two bits of ADMUX) and select the +	// channel (low 4 bits).  this also sets ADLAR (left-adjust result) +	// to 0 (the default). +#if defined(ADMUX) +#if defined(__AVR_ATtiny25__) || defined(__AVR_ATtiny45__) || defined(__AVR_ATtiny85__) +	ADMUX = (analog_reference << 4) | (pin & 0x07); +#else +	ADMUX = (analog_reference << 6) | (pin & 0x07); +#endif +#endif + +	// without a delay, we seem to read from the wrong channel +	//delay(1); + +#if defined(ADCSRA) && defined(ADC) +	// start the conversion +	sbi(ADCSRA, ADSC); + +	// ADSC is cleared when the conversion finishes +	while (bit_is_set(ADCSRA, ADSC)); + +	// ADC macro takes care of reading ADC register. +	// avr-gcc implements the proper reading order: ADCL is read first. +	return ADC; +#else +	// we dont have an ADC, return 0 +	return 0; +#endif +} + +// Right now, PWM output only works on the pins with +// hardware support.  These are defined in the appropriate +// pins_*.c file.  For the rest of the pins, we default +// to digital output. +void analogWrite(uint8_t pin, int val) +{ +	// We need to make sure the PWM output is enabled for those pins +	// that support it, as we turn it off when digitally reading or +	// writing with them.  Also, make sure the pin is in output mode +	// for consistenty with Wiring, which doesn't require a pinMode +	// call for the analog output pins. +	pinMode(pin, OUTPUT); +	if (val == 0) +	{ +		digitalWrite(pin, LOW); +	} +	else if (val == 255) +	{ +		digitalWrite(pin, HIGH); +	} +	else +	{ +		switch(digitalPinToTimer(pin)) +		{ +			// XXX fix needed for atmega8 +			#if defined(TCCR0) && defined(COM00) && !defined(__AVR_ATmega8__) +			case TIMER0A: +				// connect pwm to pin on timer 0 +				sbi(TCCR0, COM00); +				OCR0 = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR0A) && defined(COM0A1) +			case TIMER0A: +				// connect pwm to pin on timer 0, channel A +				sbi(TCCR0A, COM0A1); +				OCR0A = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR0A) && defined(COM0B1) +			case TIMER0B: +				// connect pwm to pin on timer 0, channel B +				sbi(TCCR0A, COM0B1); +				OCR0B = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR1A) && defined(COM1A1) +			case TIMER1A: +				// connect pwm to pin on timer 1, channel A +				sbi(TCCR1A, COM1A1); +				OCR1A = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR1A) && defined(COM1B1) +			case TIMER1B: +				// connect pwm to pin on timer 1, channel B +				sbi(TCCR1A, COM1B1); +				OCR1B = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR1A) && defined(COM1C1) +			case TIMER1C: +				// connect pwm to pin on timer 1, channel C +				sbi(TCCR1A, COM1C1); +				OCR1C = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR2) && defined(COM21) +			case TIMER2: +				// connect pwm to pin on timer 2 +				sbi(TCCR2, COM21); +				OCR2 = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR2A) && defined(COM2A1) +			case TIMER2A: +				// connect pwm to pin on timer 2, channel A +				sbi(TCCR2A, COM2A1); +				OCR2A = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR2A) && defined(COM2B1) +			case TIMER2B: +				// connect pwm to pin on timer 2, channel B +				sbi(TCCR2A, COM2B1); +				OCR2B = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR3A) && defined(COM3A1) +			case TIMER3A: +				// connect pwm to pin on timer 3, channel A +				sbi(TCCR3A, COM3A1); +				OCR3A = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR3A) && defined(COM3B1) +			case TIMER3B: +				// connect pwm to pin on timer 3, channel B +				sbi(TCCR3A, COM3B1); +				OCR3B = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR3A) && defined(COM3C1) +			case TIMER3C: +				// connect pwm to pin on timer 3, channel C +				sbi(TCCR3A, COM3C1); +				OCR3C = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR4A) +			case TIMER4A: +				//connect pwm to pin on timer 4, channel A +				sbi(TCCR4A, COM4A1); +				#if defined(COM4A0)		// only used on 32U4 +				cbi(TCCR4A, COM4A0); +				#endif +				OCR4A = val;	// set pwm duty +				break; +			#endif +			 +			#if defined(TCCR4A) && defined(COM4B1) +			case TIMER4B: +				// connect pwm to pin on timer 4, channel B +				sbi(TCCR4A, COM4B1); +				OCR4B = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR4A) && defined(COM4C1) +			case TIMER4C: +				// connect pwm to pin on timer 4, channel C +				sbi(TCCR4A, COM4C1); +				OCR4C = val; // set pwm duty +				break; +			#endif +				 +			#if defined(TCCR4C) && defined(COM4D1) +			case TIMER4D:				 +				// connect pwm to pin on timer 4, channel D +				sbi(TCCR4C, COM4D1); +				#if defined(COM4D0)		// only used on 32U4 +				cbi(TCCR4C, COM4D0); +				#endif +				OCR4D = val;	// set pwm duty +				break; +			#endif + +							 +			#if defined(TCCR5A) && defined(COM5A1) +			case TIMER5A: +				// connect pwm to pin on timer 5, channel A +				sbi(TCCR5A, COM5A1); +				OCR5A = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR5A) && defined(COM5B1) +			case TIMER5B: +				// connect pwm to pin on timer 5, channel B +				sbi(TCCR5A, COM5B1); +				OCR5B = val; // set pwm duty +				break; +			#endif + +			#if defined(TCCR5A) && defined(COM5C1) +			case TIMER5C: +				// connect pwm to pin on timer 5, channel C +				sbi(TCCR5A, COM5C1); +				OCR5C = val; // set pwm duty +				break; +			#endif + +			case NOT_ON_TIMER: +			default: +				if (val < 128) { +					digitalWrite(pin, LOW); +				} else { +					digitalWrite(pin, HIGH); +				} +		} +	} +} + diff --git a/cores/xinput/wiring_digital.c b/cores/xinput/wiring_digital.c new file mode 100644 index 0000000..432a150 --- /dev/null +++ b/cores/xinput/wiring_digital.c @@ -0,0 +1,179 @@ +/* +  wiring_digital.c - digital input and output functions +  Part of Arduino - http://www.arduino.cc/ + +  Copyright (c) 2005-2006 David A. Mellis + +  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., 59 Temple Place, Suite 330, +  Boston, MA  02111-1307  USA + +  Modified 28 September 2010 by Mark Sproul +*/ + +#define ARDUINO_MAIN +#include "wiring_private.h" +#include "pins_arduino.h" + +void pinMode(uint8_t pin, uint8_t mode) +{ +	uint8_t bit = digitalPinToBitMask(pin); +	uint8_t port = digitalPinToPort(pin); +	volatile uint8_t *reg, *out; + +	if (port == NOT_A_PIN) return; + +	// JWS: can I let the optimizer do this? +	reg = portModeRegister(port); +	out = portOutputRegister(port); + +	if (mode == INPUT) {  +		uint8_t oldSREG = SREG; +                cli(); +		*reg &= ~bit; +		*out &= ~bit; +		SREG = oldSREG; +	} else if (mode == INPUT_PULLUP) { +		uint8_t oldSREG = SREG; +                cli(); +		*reg &= ~bit; +		*out |= bit; +		SREG = oldSREG; +	} else { +		uint8_t oldSREG = SREG; +                cli(); +		*reg |= bit; +		SREG = oldSREG; +	} +} + +// Forcing this inline keeps the callers from having to push their own stuff +// on the stack. It is a good performance win and only takes 1 more byte per +// user than calling. (It will take more bytes on the 168.) +// +// But shouldn't this be moved into pinMode? Seems silly to check and do on +// each digitalread or write. +// +// Mark Sproul: +// - Removed inline. Save 170 bytes on atmega1280 +// - changed to a switch statement; added 32 bytes but much easier to read and maintain. +// - Added more #ifdefs, now compiles for atmega645 +// +//static inline void turnOffPWM(uint8_t timer) __attribute__ ((always_inline)); +//static inline void turnOffPWM(uint8_t timer) +static void turnOffPWM(uint8_t timer) +{ +	switch (timer) +	{ +		#if defined(TCCR1A) && defined(COM1A1) +		case TIMER1A:   cbi(TCCR1A, COM1A1);    break; +		#endif +		#if defined(TCCR1A) && defined(COM1B1) +		case TIMER1B:   cbi(TCCR1A, COM1B1);    break; +		#endif +		#if defined(TCCR1A) && defined(COM1C1) +		case TIMER1C:   cbi(TCCR1A, COM1C1);    break; +		#endif +		 +		#if defined(TCCR2) && defined(COM21) +		case  TIMER2:   cbi(TCCR2, COM21);      break; +		#endif +		 +		#if defined(TCCR0A) && defined(COM0A1) +		case  TIMER0A:  cbi(TCCR0A, COM0A1);    break; +		#endif +		 +		#if defined(TCCR0A) && defined(COM0B1) +		case  TIMER0B:  cbi(TCCR0A, COM0B1);    break; +		#endif +		#if defined(TCCR2A) && defined(COM2A1) +		case  TIMER2A:  cbi(TCCR2A, COM2A1);    break; +		#endif +		#if defined(TCCR2A) && defined(COM2B1) +		case  TIMER2B:  cbi(TCCR2A, COM2B1);    break; +		#endif +		 +		#if defined(TCCR3A) && defined(COM3A1) +		case  TIMER3A:  cbi(TCCR3A, COM3A1);    break; +		#endif +		#if defined(TCCR3A) && defined(COM3B1) +		case  TIMER3B:  cbi(TCCR3A, COM3B1);    break; +		#endif +		#if defined(TCCR3A) && defined(COM3C1) +		case  TIMER3C:  cbi(TCCR3A, COM3C1);    break; +		#endif + +		#if defined(TCCR4A) && defined(COM4A1) +		case  TIMER4A:  cbi(TCCR4A, COM4A1);    break; +		#endif					 +		#if defined(TCCR4A) && defined(COM4B1) +		case  TIMER4B:  cbi(TCCR4A, COM4B1);    break; +		#endif +		#if defined(TCCR4A) && defined(COM4C1) +		case  TIMER4C:  cbi(TCCR4A, COM4C1);    break; +		#endif			 +		#if defined(TCCR4C) && defined(COM4D1) +		case TIMER4D:	cbi(TCCR4C, COM4D1);	break; +		#endif			 +			 +		#if defined(TCCR5A) +		case  TIMER5A:  cbi(TCCR5A, COM5A1);    break; +		case  TIMER5B:  cbi(TCCR5A, COM5B1);    break; +		case  TIMER5C:  cbi(TCCR5A, COM5C1);    break; +		#endif +	} +} + +void digitalWrite(uint8_t pin, uint8_t val) +{ +	uint8_t timer = digitalPinToTimer(pin); +	uint8_t bit = digitalPinToBitMask(pin); +	uint8_t port = digitalPinToPort(pin); +	volatile uint8_t *out; + +	if (port == NOT_A_PIN) return; + +	// If the pin that support PWM output, we need to turn it off +	// before doing a digital write. +	if (timer != NOT_ON_TIMER) turnOffPWM(timer); + +	out = portOutputRegister(port); + +	uint8_t oldSREG = SREG; +	cli(); + +	if (val == LOW) { +		*out &= ~bit; +	} else { +		*out |= bit; +	} + +	SREG = oldSREG; +} + +int digitalRead(uint8_t pin) +{ +	uint8_t timer = digitalPinToTimer(pin); +	uint8_t bit = digitalPinToBitMask(pin); +	uint8_t port = digitalPinToPort(pin); + +	if (port == NOT_A_PIN) return LOW; + +	// If the pin that support PWM output, we need to turn it off +	// before getting a digital reading. +	if (timer != NOT_ON_TIMER) turnOffPWM(timer); + +	if (*portInputRegister(port) & bit) return HIGH; +	return LOW; +} diff --git a/cores/xinput/wiring_private.h b/cores/xinput/wiring_private.h new file mode 100644 index 0000000..a277b14 --- /dev/null +++ b/cores/xinput/wiring_private.h @@ -0,0 +1,72 @@ +/* +  wiring_private.h - Internal header file. +  Part of Arduino - http://www.arduino.cc/ + +  Copyright (c) 2005-2006 David A. Mellis + +  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., 59 Temple Place, Suite 330, +  Boston, MA  02111-1307  USA +*/ + +#ifndef WiringPrivate_h +#define WiringPrivate_h + +#include <avr/io.h> +#include <avr/interrupt.h> +#include <stdio.h> +#include <stdarg.h> + +#include "Arduino.h" + +#ifdef __cplusplus +extern "C"{ +#endif + +#ifndef cbi +#define cbi(sfr, bit) (_SFR_BYTE(sfr) &= ~_BV(bit)) +#endif +#ifndef sbi +#define sbi(sfr, bit) (_SFR_BYTE(sfr) |= _BV(bit)) +#endif + +uint32_t countPulseASM(volatile uint8_t *port, uint8_t bit, uint8_t stateMask, unsigned long maxloops); + +#define EXTERNAL_INT_0 0 +#define EXTERNAL_INT_1 1 +#define EXTERNAL_INT_2 2 +#define EXTERNAL_INT_3 3 +#define EXTERNAL_INT_4 4 +#define EXTERNAL_INT_5 5 +#define EXTERNAL_INT_6 6 +#define EXTERNAL_INT_7 7 + +#if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__) || defined(__AVR_ATmega128RFA1__) || defined(__AVR_ATmega256RFR2__) || \ +    defined(__AVR_AT90USB82__) || defined(__AVR_AT90USB162__) || defined(__AVR_ATmega32U2__) || defined(__AVR_ATmega16U2__) || defined(__AVR_ATmega8U2__) +#define EXTERNAL_NUM_INTERRUPTS 8 +#elif defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__) || defined(__AVR_ATmega644__) || defined(__AVR_ATmega644A__) || defined(__AVR_ATmega644P__) || defined(__AVR_ATmega644PA__) +#define EXTERNAL_NUM_INTERRUPTS 3 +#elif defined(__AVR_ATmega32U4__) +#define EXTERNAL_NUM_INTERRUPTS 5 +#else +#define EXTERNAL_NUM_INTERRUPTS 2 +#endif + +typedef void (*voidFuncPtr)(void); + +#ifdef __cplusplus +} // extern "C" +#endif + +#endif diff --git a/cores/xinput/wiring_pulse.S b/cores/xinput/wiring_pulse.S new file mode 100644 index 0000000..1dd22e6 --- /dev/null +++ b/cores/xinput/wiring_pulse.S @@ -0,0 +1,178 @@ +/* +  wiring_pulse.s - pulseInASM() function in different flavours +  Part of Arduino - http://www.arduino.cc/ + +  Copyright (c) 2014 Martino Facchin + +  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., 59 Temple Place, Suite 330, +  Boston, MA  02111-1307  USA +*/ + +/* + * The following routine was generated by avr-gcc 4.8.3 with the following parameters + * -gstabs -Wa,-ahlmsd=output.lst -dp -fverbose-asm -O2 + * on the original C function + * + * unsigned long pulseInSimpl(volatile uint8_t *port, uint8_t bit, uint8_t stateMask, unsigned long maxloops) + * { + *     unsigned long width = 0; + *     // wait for any previous pulse to end + *     while ((*port & bit) == stateMask) + *         if (--maxloops == 0) + *             return 0; + * + *     // wait for the pulse to start + *     while ((*port & bit) != stateMask) + *         if (--maxloops == 0) + *             return 0; + * + *     // wait for the pulse to stop + *     while ((*port & bit) == stateMask) { + *         if (++width == maxloops) + *             return 0; + *     } + *     return width; + * } + * + * some compiler outputs were removed but the rest of the code is untouched + */ + +#include <avr/io.h> + +.section .text + +.global countPulseASM + +countPulseASM: + +.LM0: +.LFBB1: +    push r12   ;   ;  130 pushqi1/1 [length = 1] +    push r13   ;   ;  131 pushqi1/1 [length = 1] +    push r14   ;   ;  132 pushqi1/1 [length = 1] +    push r15   ;   ;  133 pushqi1/1 [length = 1] +    push r16   ;   ;  134 pushqi1/1 [length = 1] +    push r17   ;   ;  135 pushqi1/1 [length = 1] +/* prologue: function */ +/* frame size = 0 */ +/* stack size = 6 */ +.L__stack_usage = 6 +    mov r30,r24  ;  port, port   ;  2 *movhi/1  [length = 2] +    mov r31,r25  ;  port, port +/*     unsigned long width = 0; +***     // wait for any previous pulse to end +***     while ((*port & bit) == stateMask) +*/ +.LM1: +    rjmp .L2   ;   ;  181 jump  [length = 1] +.L4: +/*         if (--maxloops == 0) */ +.LM2: +    subi r16,1   ;  maxloops,  ;  17  addsi3/2  [length = 4] +    sbc r17, r1   ;  maxloops +    sbc r18, r1   ;  maxloops +    sbc r19, r1   ;  maxloops +    breq .L13  ; ,   ;  19  branch  [length = 1] +.L2: +/*         if (--maxloops == 0) */ +.LM3: +    ld r25,Z   ;  D.1554, *port_7(D)   ;  22  movqi_insn/4  [length = 1] +    and r25,r22  ;  D.1554, bit  ;  24  andqi3/1  [length = 1] +    cp r25,r20   ;  D.1554, stateMask  ;  25  *cmpqi/2  [length = 1] +    breq .L4   ; ,   ;  26  branch  [length = 1] +    rjmp .L6   ;   ;  184 jump  [length = 1] +.L7: +/*             return 0; +*** +***     // wait for the pulse to start +***     while ((*port & bit) != stateMask) +***         if (--maxloops == 0) +*/ +.LM4: +    subi r16,1   ;  maxloops,  ;  31  addsi3/2  [length = 4] +    sbc r17, r1   ;  maxloops +    sbc r18, r1   ;  maxloops +    sbc r19, r1   ;  maxloops +    breq .L13  ; ,   ;  33  branch  [length = 1] +.L6: +/*         if (--maxloops == 0) */ +.LM5: +    ld r25,Z   ;  D.1554, *port_7(D)   ;  41  movqi_insn/4  [length = 1] +    and r25,r22  ;  D.1554, bit  ;  43  andqi3/1  [length = 1] +    cpse r25,r20   ;  D.1554, stateMask  ;  44  enable_interrupt-3  [length = 1] +    rjmp .L7   ; +    mov r12, r1   ;  width  ;  7 *movsi/2  [length = 4] +    mov r13, r1   ;  width +    mov r14, r1   ;  width +    mov r15, r1   ;  width +    rjmp .L9   ;   ;  186 jump  [length = 1] +.L10: +/*             return 0; +*** +***     // wait for the pulse to stop +***     while ((*port & bit) == stateMask) { +***         if (++width == maxloops) +*/ +.LM6: +    ldi r24,-1   ; ,   ;  50  addsi3/3  [length = 5] +    sub r12,r24  ;  width, +    sbc r13,r24  ;  width, +    sbc r14,r24  ;  width, +    sbc r15,r24  ;  width, +    cp r16,r12   ;  maxloops, width  ;  51  *cmpsi/2  [length = 4] +    cpc r17,r13  ;  maxloops, width +    cpc r18,r14  ;  maxloops, width +    cpc r19,r15  ;  maxloops, width +    breq .L13  ; ,   ;  52  branch  [length = 1] +.L9: +/*         if (++width == maxloops) */ +.LM7: +    ld r24,Z   ;  D.1554, *port_7(D)   ;  60  movqi_insn/4  [length = 1] +    and r24,r22  ;  D.1554, bit  ;  62  andqi3/1  [length = 1] +    cp r24,r20   ;  D.1554, stateMask  ;  63  *cmpqi/2  [length = 1] +    breq .L10  ; ,   ;  64  branch  [length = 1] +/*             return 0; +***     } +***     return width; +*/ +.LM8: +    mov r22,r12  ;  D.1553, width  ;  108 movqi_insn/1  [length = 1] +    mov r23,r13  ;  D.1553, width  ;  109 movqi_insn/1  [length = 1] +    mov r24,r14  ;  D.1553, width  ;  110 movqi_insn/1  [length = 1] +    mov r25,r15  ;  D.1553, width  ;  111 movqi_insn/1  [length = 1] +/* epilogue start */ +.LM9: +    pop r17  ;   ;  171 popqi [length = 1] +    pop r16  ;   ;  172 popqi [length = 1] +    pop r15  ;   ;  173 popqi [length = 1] +    pop r14  ;   ;  174 popqi [length = 1] +    pop r13  ;   ;  175 popqi [length = 1] +    pop r12  ;   ;  176 popqi [length = 1] +    ret  ;  177 return_from_epilogue  [length = 1] +.L13: +.LM10: +    ldi r22,0  ;  D.1553   ;  120 movqi_insn/1  [length = 1] +    ldi r23,0  ;  D.1553   ;  121 movqi_insn/1  [length = 1] +    ldi r24,0  ;  D.1553   ;  122 movqi_insn/1  [length = 1] +    ldi r25,0  ;  D.1553   ;  123 movqi_insn/1  [length = 1] +/* epilogue start */ +.LM11: +    pop r17  ;   ;  138 popqi [length = 1] +    pop r16  ;   ;  139 popqi [length = 1] +    pop r15  ;   ;  140 popqi [length = 1] +    pop r14  ;   ;  141 popqi [length = 1] +    pop r13  ;   ;  142 popqi [length = 1] +    pop r12  ;   ;  143 popqi [length = 1] +    ret  ;  144 return_from_epilogue  [length = 1] diff --git a/cores/xinput/wiring_pulse.c b/cores/xinput/wiring_pulse.c new file mode 100644 index 0000000..d6e0434 --- /dev/null +++ b/cores/xinput/wiring_pulse.c @@ -0,0 +1,93 @@ +/* +  wiring_pulse.c - pulseIn() function +  Part of Arduino - http://www.arduino.cc/ + +  Copyright (c) 2005-2006 David A. Mellis + +  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., 59 Temple Place, Suite 330, +  Boston, MA  02111-1307  USA +*/ + +#include "wiring_private.h" +#include "pins_arduino.h" + +/* Measures the length (in microseconds) of a pulse on the pin; state is HIGH + * or LOW, the type of pulse to measure.  Works on pulses from 2-3 microseconds + * to 3 minutes in length, but must be called at least a few dozen microseconds + * before the start of the pulse. + * + * This function performs better with short pulses in noInterrupt() context + */ +unsigned long pulseIn(uint8_t pin, uint8_t state, unsigned long timeout) +{ +	// cache the port and bit of the pin in order to speed up the +	// pulse width measuring loop and achieve finer resolution.  calling +	// digitalRead() instead yields much coarser resolution. +	uint8_t bit = digitalPinToBitMask(pin); +	uint8_t port = digitalPinToPort(pin); +	uint8_t stateMask = (state ? bit : 0); + +	// convert the timeout from microseconds to a number of times through +	// the initial loop; it takes approximately 16 clock cycles per iteration +	unsigned long maxloops = microsecondsToClockCycles(timeout)/16; + +	unsigned long width = countPulseASM(portInputRegister(port), bit, stateMask, maxloops); + +	// prevent clockCyclesToMicroseconds to return bogus values if countPulseASM timed out +	if (width) +		return clockCyclesToMicroseconds(width * 16 + 16); +	else +		return 0; +} + +/* Measures the length (in microseconds) of a pulse on the pin; state is HIGH + * or LOW, the type of pulse to measure.  Works on pulses from 2-3 microseconds + * to 3 minutes in length, but must be called at least a few dozen microseconds + * before the start of the pulse. + * + * ATTENTION: + * this function relies on micros() so cannot be used in noInterrupt() context + */ +unsigned long pulseInLong(uint8_t pin, uint8_t state, unsigned long timeout) +{ +	// cache the port and bit of the pin in order to speed up the +	// pulse width measuring loop and achieve finer resolution.  calling +	// digitalRead() instead yields much coarser resolution. +	uint8_t bit = digitalPinToBitMask(pin); +	uint8_t port = digitalPinToPort(pin); +	uint8_t stateMask = (state ? bit : 0); + +	unsigned long startMicros = micros(); + +	// wait for any previous pulse to end +	while ((*portInputRegister(port) & bit) == stateMask) { +		if (micros() - startMicros > timeout) +			return 0; +	} + +	// wait for the pulse to start +	while ((*portInputRegister(port) & bit) != stateMask) { +		if (micros() - startMicros > timeout) +			return 0; +	} + +	unsigned long start = micros(); +	// wait for the pulse to stop +	while ((*portInputRegister(port) & bit) == stateMask) { +		if (micros() - startMicros > timeout) +			return 0; +	} +	return micros() - start; +} diff --git a/cores/xinput/wiring_shift.c b/cores/xinput/wiring_shift.c new file mode 100644 index 0000000..a9b3be5 --- /dev/null +++ b/cores/xinput/wiring_shift.c @@ -0,0 +1,56 @@ +/* +  wiring_shift.c - shiftOut() function +  Part of Arduino - http://www.arduino.cc/ + +  Copyright (c) 2005-2006 David A. Mellis + +  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., 59 Temple Place, Suite 330, +  Boston, MA  02111-1307  USA +*/ + +#include "wiring_private.h" + +uint8_t shiftIn(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder) { +	uint8_t value = 0; +	uint8_t i; + +	for (i = 0; i < 8; ++i) { +		digitalWrite(clockPin, HIGH); +		if (bitOrder == LSBFIRST) +			value |= digitalRead(dataPin) << i; +		else +			value |= digitalRead(dataPin) << (7 - i); +		digitalWrite(clockPin, LOW); +	} +	return value; +} + +void shiftOut(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder, uint8_t val) +{ +	uint8_t i; + +	for (i = 0; i < 8; i++)  { +		if (bitOrder == LSBFIRST) { +			digitalWrite(dataPin, val & 1); +			val >>= 1; +		} else {	 +			digitalWrite(dataPin, (val & 128) != 0); +			val <<= 1; +		} +			 +		digitalWrite(clockPin, HIGH); +		digitalWrite(clockPin, LOW);		 +	} +} diff --git a/cores/xinput/xinput/USB_XInput_API.cpp b/cores/xinput/xinput/USB_XInput_API.cpp new file mode 100644 index 0000000..ffd818c --- /dev/null +++ b/cores/xinput/xinput/USB_XInput_API.cpp @@ -0,0 +1,57 @@ +/* + *  Project     Arduino XInput - AVR Core + *  @author     David Madison + *  @link       github.com/dmadison/ArduinoXInput_AVR + *  @license    MIT - Copyright (c) 2019 David Madison + * + * 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. + * + */ + +#include "USB_XInput_API.h" + +#ifdef USB_XINPUT + +void (*XInputUSB::RecvCallback)(void) = nullptr; + +boolean XInputUSB::connected() { +	return USBDevice.configured(); +} + +uint8_t XInputUSB::available() { +	return USB_Available(XINPUT_RX_ENDPOINT); +} + +int XInputUSB::recv(void *buffer, uint8_t nbytes) { +	return USB_Recv(XINPUT_RX_ENDPOINT, buffer, nbytes); +} + +int XInputUSB::send(const void *buffer, uint8_t nbytes) { +	int result = USB_Send(XINPUT_TX_ENDPOINT, buffer, nbytes); +	if (result > 0) { +		USB_Flush(XINPUT_TX_ENDPOINT); +	} +	return result; +} + +void XInputUSB::setRecvCallback(void(*callback)(void)) { +	XInputUSB::RecvCallback = callback; +} + +#endif /* ifdef USB_XINPUT */ diff --git a/cores/xinput/xinput/USB_XInput_API.h b/cores/xinput/xinput/USB_XInput_API.h new file mode 100644 index 0000000..11fa100 --- /dev/null +++ b/cores/xinput/xinput/USB_XInput_API.h @@ -0,0 +1,51 @@ +/* + *  Project     Arduino XInput - AVR Core + *  @author     David Madison + *  @link       github.com/dmadison/ArduinoXInput_AVR + *  @license    MIT - Copyright (c) 2019 David Madison + * + * 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. + * + */ + +#include "USBAPI.h" + +#ifndef USB_XINPUT_API_H +#define USB_XINPUT_API_H + +#ifdef USBCON + +#define USB_XINPUT + +class XInputUSB { +public: +	// API +	static bool connected(void); +	static uint8_t available(void); +	static int send(const void *buffer, uint8_t nbytes); +	static int recv(void *buffer, uint8_t nbytes); +	static void setRecvCallback(void(*callback)(void)); + +	// Non-API Data +	static void (*RecvCallback)(void); +}; + +#endif /* if defined(USBCON) */ + +#endif /* ifndef USB_XINPUT_API_H */ diff --git a/cores/xinput/xinput/USB_XInput_Descriptors.cpp b/cores/xinput/xinput/USB_XInput_Descriptors.cpp new file mode 100644 index 0000000..f57c700 --- /dev/null +++ b/cores/xinput/xinput/USB_XInput_Descriptors.cpp @@ -0,0 +1,210 @@ +/* + *  Project     Arduino XInput - AVR Core + *  @author     David Madison + *  @link       github.com/dmadison/ArduinoXInput_AVR + *  @license    MIT - Copyright (c) 2019 David Madison + * + * 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. + * + */ + +#include "USB_XInput_Descriptors.h" + +#if defined(USBCON) + +const DeviceDescriptor USB_DeviceDescriptor = { +	0x12,           // bLength (18) +	0x01,           // bDescriptorType (DEVICE) +	USB_VERSION,    // bcdUSB (2.0) +	0xFF,           // bDeviceClass +	0xFF,           // bDeviceSubClass +	0xFF,           // bDeviceProtocol +	0x40,           // bMaxPacketSize0 +	USB_VID,        // idEVendor +	USB_PID,        // idProduct +	0x114,          // bcdDevice +	IMANUFACTURER,  // iManufacturer +	IPRODUCT,       // iProduct +	ISERIAL,        // iSerialNumber +	0x01,           // bNumConfigurations +}; + +const u8 USB_ConfigDescriptor[] = { +	// Configuration Descriptor +	0x09,        // bLength +	0x02,        // bDescriptorType (CONFIGURATION) +	0x99, 0x00,  // wTotalLength (153) +	0x04,        // bNumInterfaces +	0x01,        // bConfigurationValue +	0x00,        // iConfiguration +	0xA0,        // bmAttributes +	0xFA,        // bMaxPower + +	/* ---------------------------------------------------- */ +	// Interface 0: Control Data +	0x09,        // bLength +	0x04,        // bDescriptorType (INTERFACE) +	0x00,        // bInterfaceNumber +	0x00,        // bAlternateSetting +	0x02,        // bNumEndpoints +	0xFF,        // bInterfaceClass +	0x5D,        // bInterfaceSubClass +	0x01,        // bInterfaceProtocol +	0x00,        // iInterface + +	// Unknown Descriptor (If0) +	0x11,        // bLength +	0x21,        // bDescriptorType +	0x00, 0x01, 0x01, 0x25,  // ??? +	0x81,        // bEndpointAddress (IN, 1) +	0x14,        // bMaxDataSize +	0x00, 0x00, 0x00, 0x00, 0x13,  // ??? +	0x02,        // bEndpointAddress (OUT, 2) +	0x08,        // bMaxDataSize +	0x00, 0x00,  // ??? + +	// Endpoint 1: Control Surface Send +	0x07,        // bLength +	0x05,        // bDescriptorType (ENDPOINT) +	0x81,        // bEndpointAddress (IN, 1) +	0x03,        // bmAttributes +	0x20, 0x00,  // wMaxPacketSize +	0x04,        // bInterval + +	// Endpoint 1: Control Surface Receive +	0x07,        // bLength +	0x05,        // bDescriptorType (ENDPOINT) +	0x02,        // bEndpointAddress (OUT, 2) +	0x03,        // bmAttributes +	0x20, 0x00,  // wMaxPacketSize +	0x08,        // bInterval + +	/* ---------------------------------------------------- */ +	// Interface 1: Headset (and Expansion Port?) +	0x09,        // bLength +	0x04,        // bDescriptorType (INTERFACE) +	0x01,        // bInterfaceNumber +	0x00,        // bAlternateSetting +	0x04,        // bNumEndpoints +	0xFF,        // bInterfaceClass +	0x5D,        // bInterfaceSubClass +	0x03,        // bInterfaceProtocol +	0x00,        // iInterface + +	// Unknown Descriptor (If1) +	0x1B,        // bLength +	0x21,        // bDescriptorType +	0x00, 0x01, 0x01, 0x01,  // ??? +	0x83,        // bEndpointAddress (IN, 3) +	0x40,        // bMaxDataSize +	0x01,        // ??? +	0x04,        // bEndpointAddress (OUT, 4) +	0x20,        // bMaxDataSize +	0x16,        // ??? +	0x85,        // bEndpointAddress (IN, 5) +	0x00,        // bMaxDataSize +	0x00, 0x00, 0x00, 0x00, 0x00, 0x16,  // ??? +	0x05,        // bEndpointAddress (OUT, 5) +	0x00,        // bMaxDataSize +	0x00, 0x00, 0x00, 0x00, 0x00,  // ??? + +	// Endpoint 2: Microphone Data Send +	0x07,        // bLength +	0x05,        // bDescriptorType (ENDPOINT) +	0x83,        // bEndpointAddress (IN, 3) +	0x03,        // bmAttributes +	0x20, 0x00,  // wMaxPacketSize +	0x02,        // bInterval + +	// Endpoint 2: Headset Audio Receive +	0x07,        // bLength +	0x05,        // bDescriptorType (ENDPOINT) +	0x04,        // bEndpointAddress (OUT, 4) +	0x03,        // bmAttributes +	0x20, 0x00,  // wMaxPacketSize +	0x04,        // bInterval + +	// Endpoint 3: Unknown, Send +	0x07,        // bLength +	0x05,        // bDescriptorType (ENDPOINT) +	0x85,        // bEndpointAddress (IN, 5) +	0x03,        // bmAttributes +	0x20, 0x00,  // wMaxPacketSize +	0x40,        // bInterval + +	// Endpoint 3: Unknown, Receive +	0x07,        // bLength +	0x05,        // bDescriptorType (ENDPOINT) +	0x05,        // bEndpointAddress (OUT, 5) +	0x03,        // bmAttributes +	0x20, 0x00,  // wMaxPacketSize +	0x10,        // bInterval + +	/* ---------------------------------------------------- */ +	// Interface 2: Unknown +	0x09,        // bLength +	0x04,        // bDescriptorType (INTERFACE) +	0x02,        // bInterfaceNumber +	0x00,        // bAlternateSetting +	0x01,        // bNumEndpoints +	0xFF,        // bInterfaceClass +	0x5D,        // bInterfaceSubClass +	0x02,        // bInterfaceProtocol +	0x00,        // iInterface + +	// Unknown Descriptor (If2) +	0x09,        // bLength +	0x21,        // bDescriptorType +	0x00, 0x01, 0x01, 0x22,  // ??? +	0x86,        // bEndpointAddress (IN, 6) +	0x07,        // bMaxDataSize +	0x00,        // ??? + +	// Endpoint 4: Unknown, Send +	0x07,        // bLength +	0x05,        // bDescriptorType (ENDPOINT) +	0x86,        // bEndpointAddress (IN, 6) +	0x03,        // bmAttributes +	0x20, 0x00,  // wMaxPacketSize +	0x10,        // bInterval + +	/* ---------------------------------------------------- */ +	// Interface 3: Security Method +	0x09,        // bLength +	0x04,        // bDescriptorType (INTERFACE) +	0x03,        // bInterfaceNumber +	0x00,        // bAlternateSetting +	0x00,        // bNumEndpoints +	0xFF,        // bInterfaceClass +	0xFD,        // bInterfaceSubClass +	0x13,        // bInterfaceProtocol +	0x04,        // iInterface + +	// Unknown Descriptor (If3) +	0x06,        // bLength +	0x41,        // bDescriptorType +	0x00, 0x01, 0x01, 0x03,  // ??? +}; + +const u16 USB_ConfigDescriptorSize = sizeof(USB_ConfigDescriptor); + +const u8 STRING_SERIAL[] = "Arduino XInput AVR"; +const u8 STRING_SECURITY[] = "Xbox Security Method 3, Version 1.00, \xA9 2005 Microsoft Corporation. All rights reserved."; + +#endif /* if defined(USBCON) */ diff --git a/cores/xinput/xinput/USB_XInput_Descriptors.h b/cores/xinput/xinput/USB_XInput_Descriptors.h new file mode 100644 index 0000000..976fe56 --- /dev/null +++ b/cores/xinput/xinput/USB_XInput_Descriptors.h @@ -0,0 +1,53 @@ +/* + *  Project     Arduino XInput - AVR Core + *  @author     David Madison + *  @link       github.com/dmadison/ArduinoXInput_AVR + *  @license    MIT - Copyright (c) 2019 David Madison + * + * 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. + * + */ + +#include "USBAPI.h" + +#ifndef USB_XINPUT_DESCRIPTORS_H +#define USB_XINPUT_DESCRIPTORS_H + +#if defined(USBCON) + +// Device Descriptor +extern const DeviceDescriptor USB_DeviceDescriptor PROGMEM; + +// Config Descriptor +extern const u8  USB_ConfigDescriptor[] PROGMEM; +extern const u16 USB_ConfigDescriptorSize PROGMEM; + +// String Descriptors +extern const u8 STRING_SERIAL[] PROGMEM; +extern const u8 STRING_SECURITY[] PROGMEM; + +#define ISECURITY 4 + +// Endpoint Numbers +#define XINPUT_TX_ENDPOINT	1 +#define XINPUT_RX_ENDPOINT	2 + +#endif /* if defined(USBCON) */ + +#endif /* ifndef USB_XINPUT_DESCRIPTORS_H */ | 
