neo_rad 0.4.0

data/lib/libraries/AFSoftSerial/AFSoftSerial.cpp

@@ -0,0 +1,321 @@
+/*
+  SoftwareSerial.cpp - Software serial library
+  Copyright (c) 2006 David A. Mellis.  All right reserved. - hacked by ladyada 
+
+  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
+*/
+
+/******************************************************************************
+ * Includes
+ ******************************************************************************/
+#include <avr/interrupt.h>
+#include "WConstants.h"
+#include "AFSoftSerial.h"
+
+/******************************************************************************
+ * Definitions
+ ******************************************************************************/
+
+#define AFSS_MAX_RX_BUFF 64
+
+/******************************************************************************
+ * Statics
+ ******************************************************************************/
+static uint8_t _receivePin;
+static uint8_t _transmitPin;
+static int _bitDelay;
+
+static char _receive_buffer[AFSS_MAX_RX_BUFF]; 
+static uint8_t _receive_buffer_index;
+
+#if (F_CPU == 16000000)
+void whackDelay(uint16_t delay) { 
+  uint8_t tmp=0;
+
+  asm volatile("sbiw    %0, 0x01 \n\t"
+	       "ldi %1, 0xFF \n\t"
+	       "cpi %A0, 0xFF \n\t"
+	       "cpc %B0, %1 \n\t"
+	       "brne .-10 \n\t"
+	       : "+r" (delay), "+a" (tmp)
+	       : "0" (delay)
+	       );
+}
+#endif
+
+/******************************************************************************
+ * Interrupts
+ ******************************************************************************/
+
+SIGNAL(SIG_PIN_CHANGE0) {
+  if ((_receivePin >=8) && (_receivePin <= 13)) {
+    recv();
+  }
+}
+SIGNAL(SIG_PIN_CHANGE2)
+{
+  if (_receivePin <8) {
+    recv();
+  }
+}
+
+
+void recv(void) { 
+  char i, d = 0; 
+  if (digitalRead(_receivePin)) 
+    return;       // not ready! 
+  whackDelay(_bitDelay - 8);
+  for (i=0; i<8; i++) { 
+    //PORTB |= _BV(5); 
+    whackDelay(_bitDelay*2 - 6);  // digitalread takes some time
+    //PORTB &= ~_BV(5); 
+    if (digitalRead(_receivePin)) 
+      d |= (1 << i); 
+   } 
+  whackDelay(_bitDelay*2);
+  if (_receive_buffer_index >=  AFSS_MAX_RX_BUFF)
+    return;
+  _receive_buffer[_receive_buffer_index] = d; // save data 
+  _receive_buffer_index++;  // got a byte 
+} 
+  
+
+
+/******************************************************************************
+ * Constructors
+ ******************************************************************************/
+
+AFSoftSerial::AFSoftSerial(uint8_t receivePin, uint8_t transmitPin)
+{
+  _receivePin = receivePin;
+  _transmitPin = transmitPin;
+  _baudRate = 0;
+}
+
+void AFSoftSerial::setTX(uint8_t tx) {
+  _transmitPin = tx;
+}
+void AFSoftSerial::setRX(uint8_t rx) {
+  _receivePin = rx;
+}
+
+/******************************************************************************
+ * User API
+ ******************************************************************************/
+
+void AFSoftSerial::begin(long speed)
+{
+  pinMode(_transmitPin, OUTPUT);
+  digitalWrite(_transmitPin, HIGH);
+
+  pinMode(_receivePin, INPUT); 
+  digitalWrite(_receivePin, HIGH);  // pullup!
+
+  _baudRate = speed;
+  switch (_baudRate) {
+  case 115200: // For xmit -only-!
+    _bitDelay = 4; break;
+  case 57600:
+    _bitDelay = 14; break;
+  case 38400:
+    _bitDelay = 24; break;
+  case 31250:
+    _bitDelay = 31; break;
+  case 19200:
+    _bitDelay = 54; break;
+  case 9600:
+    _bitDelay = 113; break;
+  case 4800:
+    _bitDelay = 232; break;
+  case 2400:
+    _bitDelay = 470; break;
+  default:
+    _bitDelay = 0;
+  }    
+
+   if (_receivePin < 8) {
+     // a PIND pin, PCINT16-23
+     PCMSK2 |= _BV(_receivePin);
+     PCICR |= _BV(2);
+  } else if (_receivePin <= 13) {
+    // a PINB pin, PCINT0-5
+    PCICR |= _BV(0);    
+    PCMSK0 |= _BV(_receivePin-8);
+  } 
+
+  whackDelay(_bitDelay*2); // if we were low this establishes the end
+}
+
+int AFSoftSerial::read(void)
+{
+  uint8_t d,i;
+
+  if (! _receive_buffer_index)
+    return -1;
+
+  d = _receive_buffer[0]; // grab first byte
+  // if we were awesome we would do some nifty queue action
+  // sadly, i dont care
+  for (i=0; i<_receive_buffer_index; i++) {
+    _receive_buffer[i] = _receive_buffer[i+1];
+  }
+  _receive_buffer_index--;
+  return d;
+}
+
+uint8_t AFSoftSerial::available(void)
+{
+  return _receive_buffer_index;
+}
+
+void AFSoftSerial::print(uint8_t b)
+{
+  if (_baudRate == 0)
+    return;
+  byte mask;
+
+  cli();  // turn off interrupts for a clean txmit
+
+  digitalWrite(_transmitPin, LOW);  // startbit
+  whackDelay(_bitDelay*2);
+
+  for (mask = 0x01; mask; mask <<= 1) {
+    if (b & mask){ // choose bit
+      digitalWrite(_transmitPin,HIGH); // send 1
+    }
+    else{
+      digitalWrite(_transmitPin,LOW); // send 1
+    }
+    whackDelay(_bitDelay*2);
+  }
+  
+  digitalWrite(_transmitPin, HIGH);
+  sei();  // turn interrupts back on. hooray!
+  whackDelay(_bitDelay*2);
+}
+
+void AFSoftSerial::print(const char *s)
+{
+  while (*s)
+    print(*s++);
+}
+
+void AFSoftSerial::print(char c)
+{
+  print((uint8_t) c);
+}
+
+void AFSoftSerial::print(int n)
+{
+  print((long) n);
+}
+
+void AFSoftSerial::print(unsigned int n)
+{
+  print((unsigned long) n);
+}
+
+void AFSoftSerial::print(long n)
+{
+  if (n < 0) {
+    print('-');
+    n = -n;
+  }
+  printNumber(n, 10);
+}
+
+void AFSoftSerial::print(unsigned long n)
+{
+  printNumber(n, 10);
+}
+
+void AFSoftSerial::print(long n, int base)
+{
+  if (base == 0)
+    print((char) n);
+  else if (base == 10)
+    print(n);
+  else
+    printNumber(n, base);
+}
+
+void AFSoftSerial::println(void)
+{
+  print('\r');
+  print('\n');  
+}
+
+void AFSoftSerial::println(char c)
+{
+  print(c);
+  println();  
+}
+
+void AFSoftSerial::println(const char c[])
+{
+  print(c);
+  println();
+}
+
+void AFSoftSerial::println(uint8_t b)
+{
+  print(b);
+  println();
+}
+
+void AFSoftSerial::println(int n)
+{
+  print(n);
+  println();
+}
+
+void AFSoftSerial::println(long n)
+{
+  print(n);
+  println();  
+}
+
+void AFSoftSerial::println(unsigned long n)
+{
+  print(n);
+  println();  
+}
+
+void AFSoftSerial::println(long n, int base)
+{
+  print(n, base);
+  println();
+}
+
+// Private Methods /////////////////////////////////////////////////////////////
+
+void AFSoftSerial::printNumber(unsigned long n, uint8_t base)
+{
+  unsigned char buf[8 * sizeof(long)]; // Assumes 8-bit chars. 
+  unsigned long i = 0;
+
+  if (n == 0) {
+    print('0');
+    return;
+  } 
+
+  while (n > 0) {
+    buf[i++] = n % base;
+    n /= base;
+  }
+
+  for (; i > 0; i--)
+    print((char) (buf[i - 1] < 10 ? '0' + buf[i - 1] : 'A' + buf[i - 1] - 10));
+}

data/lib/libraries/AFSoftSerial/AFSoftSerial.h

@@ -0,0 +1,61 @@
+/*
+  SoftwareSerial.h - Software serial library
+  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 AFSoftSerial_h
+#define AFSoftSerial_h
+
+#include <inttypes.h>
+
+uint16_t whackDelay2(uint16_t delay);
+
+static void recv(void);
+
+class AFSoftSerial
+{
+  private:
+    long _baudRate;
+    void printNumber(unsigned long, uint8_t);
+    
+  public:
+    AFSoftSerial(uint8_t, uint8_t);
+    void setTX(uint8_t tx);
+    void setRX(uint8_t rx);
+    void begin(long);
+    int read();
+    uint8_t available(void);
+    void print(char);
+    void print(const char[]);
+    void print(uint8_t);
+    void print(int);
+    void print(unsigned int);
+    void print(long);
+    void print(unsigned long);
+    void print(long, int);
+    void println(void);
+    void println(char);
+    void println(const char[]);
+    void println(uint8_t);
+    void println(int);
+    void println(long);
+    void println(unsigned long);
+    void println(long, int);
+};
+
+#endif
+

data/lib/libraries/AFSoftSerial/keywords.txt

@@ -0,0 +1,18 @@
+#######################################
+# Syntax Coloring Map For Ultrasound
+#######################################
+
+#######################################
+# Datatypes (KEYWORD1)
+#######################################
+
+AFSoftSerial	KEYWORD1
+
+#######################################
+# Methods and Functions (KEYWORD2)
+#######################################
+
+#######################################
+# Constants (LITERAL1)
+#######################################
+

data/lib/libraries/AF_XPort/AF_XPort.cpp

@@ -0,0 +1,166 @@
+#include <avr/io.h>
+#include "WProgram.h"
+#include "AFSoftSerial.h"
+#include "AF_XPort.h"
+
+static AFSoftSerial xportserial = AFSoftSerial(0,0); // we dont know the pins yet
+
+AF_XPort::AF_XPort(uint8_t rx, uint8_t tx, uint8_t reset, uint8_t dtr, uint8_t rts, uint8_t cts) {
+  rxpin = rx;
+  txpin = tx;
+  resetpin = reset;
+  if (resetpin) {
+    pinMode(resetpin, OUTPUT);
+    digitalWrite(resetpin, HIGH);
+  }
+  
+  dtrpin = dtr;
+  rtspin = rts;
+  ctspin = cts;
+  if (ctspin) {
+    digitalWrite(ctspin, HIGH);
+    pinMode(ctspin, OUTPUT);
+  }
+}
+
+void AF_XPort::begin(uint16_t b) {
+  xportserial.setTX(rxpin);
+  xportserial.setRX(txpin);
+  xportserial.begin(b);
+}
+
+uint8_t AF_XPort::reset(void) {
+  char d;
+
+  if (resetpin) {
+    digitalWrite(resetpin, LOW);
+    delay(50);
+    digitalWrite(resetpin, HIGH);
+  }
+
+ // wait for 'D' for disconnected
+  if (serialavail_timeout(5000)) { // 3 second timeout 
+    d = xportserial.read();
+    //Serial.print("Read: "); Serial.print(d, HEX);
+    if (d != 'D'){
+      return ERROR_BADRESP;
+    } else {
+      return 0;
+    }
+  }
+  return ERROR_TIMEDOUT;
+}
+
+uint8_t AF_XPort::disconnected(void) {
+  if (dtrpin != 0) {
+     return digitalRead(dtrpin);
+  } 
+  return 0;
+}
+
+
+uint8_t AF_XPort::connect(char *ipaddr, long port) {
+  char ret;
+  
+  xportserial.print('C');
+  xportserial.print(ipaddr);
+  xportserial.print('/');
+  xportserial.println(port);
+  // wait for 'C'
+  if (serialavail_timeout(3000)) { // 3 second timeout 
+    ret = xportserial.read();
+    //Serial.print("Read: "); Serial.print(d, HEX);
+    if (ret != 'C') {
+      return ERROR_BADRESP;
+    }
+  } else { 
+    return ERROR_TIMEDOUT; 
+  }
+  return 0;
+}
+
+
+// check to see what data is available from the xport
+uint8_t AF_XPort::serialavail_timeout(int timeout) {  // in ms
+  while (timeout) {
+    if (xportserial.available()) {
+      if (ctspin) { // we read some stuff, time to stop!
+        digitalWrite(ctspin, HIGH);
+      }
+      return 1;
+    }
+    // nothing in the queue, tell it to send something
+    if (ctspin) {
+     digitalWrite(ctspin, LOW);
+    }
+    timeout -= 1;
+    delay(1);
+  }
+  if (ctspin) { // we may need to process some stuff, so stop now
+     digitalWrite(ctspin, HIGH);
+  }
+  return 0;
+}
+
+
+
+uint8_t AF_XPort::readline_timeout(char *buff, uint8_t maxlen, int timeout) {
+  uint8_t idx;
+  char c;
+
+  for (idx=0; idx < maxlen; idx++) {
+    buff[idx] = 0;
+    if (serialavail_timeout(timeout)) {
+      c = xportserial.read();
+      //Serial.print(c);    // debugging
+      if (c == '\n') {
+	return idx;
+      } else {
+	buff[idx] = c;
+      }
+    } else {
+      // timedout!
+      break;
+    }
+  }
+  return idx;
+}
+
+
+// clear out any extra data
+void AF_XPort::flush(int timeout) {
+  while (serialavail_timeout(timeout)) {
+    xportserial.read();
+  }
+}
+
+// on direct+ and xport's we can toggle a line to disconnect
+void AF_XPort::disconnect() {  
+  /* digitalWrite(XPORT_DISCONN, LOW);
+  delay(20);
+  digitalWrite(XPORT_DISCONN, HIGH);*/
+}
+
+// print a string from Flash, saves lots of RAM space!
+void AF_XPort::ROM_print(const char *pSTR) {
+  uint16_t i;  
+  for (i = 0; pgm_read_byte(&pSTR[i]); i++) {       
+    xportserial.print(pgm_read_byte(&pSTR[i]));  
+  } 
+}
+
+// all the prints
+void AF_XPort::print(uint8_t b) { xportserial.print(b); }
+void AF_XPort::print(const char *b) { xportserial.print(b); }
+void AF_XPort::print(char b) { xportserial.print(b); }
+void AF_XPort::print(unsigned int b) { xportserial.print(b); }
+void AF_XPort::print(long b) { xportserial.print(b); }
+void AF_XPort::print(long b, int base) { xportserial.print(b, base); }
+void AF_XPort::println(void) { xportserial.println(); }
+void AF_XPort::println(const char c[]) { xportserial.println(c); }
+void AF_XPort::println(uint8_t b) { xportserial.println(b); }
+void AF_XPort::println(int b) { xportserial.println(b); }
+void AF_XPort::println(long b) { xportserial.println(b); }
+void AF_XPort::println(unsigned long b) { xportserial.println(b); }
+void AF_XPort::println(long n, int base) { xportserial.println(n, base); }
+

data/lib/libraries/AF_XPort/AF_XPort.h

@@ -0,0 +1,48 @@
+
+#ifndef _AFXPort_h_
+#define _AFXPort_h_
+
+
+#define ERROR_NONE 0
+#define ERROR_TIMEDOUT 2
+#define ERROR_BADRESP 3
+#define ERROR_DISCONN 4
+
+#include <avr/pgmspace.h>
+
+
+class AF_XPort
+{
+ private:
+ 
+  uint8_t rxpin, txpin, resetpin, dtrpin, rtspin, ctspin;
+ public:
+  AF_XPort(uint8_t rx, uint8_t tx, uint8_t reset=0, uint8_t dtr=0, uint8_t rts=0, uint8_t cts=0);
+  void begin(uint16_t b);
+  uint8_t reset(void);
+  uint8_t serialavail_timeout(int timeout);
+  uint8_t readline_timeout(char *buff, uint8_t maxlen, int timeout);
+  void flush(int timeout);
+  void disconnect();
+  uint8_t connect(char *ipaddr, long port);
+  void ROM_print(const char *pSTR);
+  uint8_t disconnected();
+
+  void print(char);
+    void print(const char[]);
+    void print(uint8_t);
+    void print(int);
+    void print(unsigned int);
+    void print(long);
+    void print(unsigned long);
+    void print(long, int);
+    void println(void);
+    void println(char);
+    void println(const char[]);
+    void println(uint8_t);
+    void println(int);
+    void println(long);
+    void println(unsigned long);
+    void println(long, int);
+};
+#endif