Add output driver chip detect sketch

Author: harbaum

ftduino/libraries/FtduinoSimple/examples/ChipDetect/ChipDetect.ino

@@ -0,0 +1,119 @@
+// ChipDetect.ino
+//
+// Detect the output driver chip installed on the ftDuino
+
+#include <SPI.h>
+#include <Adafruit_GFX.h>
+#include "FtduinoDisplay.h"
+
+FtduinoDisplay display;
+
+#define CHIP_UNKNOWN  0
+#define CHIP_MC33879  1
+#define CHIP_TLE94108 2
+#define CHIP_DRV8908  3
+
+int chip = CHIP_UNKNOWN;
+
+const String names[] = {
+   "UNKNOWN", "MC33879", "TLE94108", "DRV8908"
+};
+
+void print_centered(char size, char y, String str) {
+  display.setTextSize(size);
+  display.setCursor(64-(str.length()*3*size), 8*y);
+  display.print(str);
+}
+
+void driver_prepare() {
+  // start the SPI library:
+  SPI.begin();
+  SPI.beginTransaction(SPISettings(250000, MSBFIRST, SPI_MODE1));
+
+  // /CS is PB.0
+  DDRB |= (1<<0);
+  
+  // For MC33879 PB.7 is the PWM input of the IN6 of O2. We don't use that
+  // feature in this driver, so it's just pulled down. This is also ok with
+  // the TLE94108 which has this pin grounded. For the DRV8908 this is the
+  // fault output which is an open collector output. Grounding that is also
+  // not a problem.  
+  DDRB |= (1<<7);
+  PORTB &= ~(1<<7);  // no PWM on IN6
+
+  // get chip out of sleep mode
+  DDRE  |= (1<<6);
+  PORTE |= (1<<6);  // not in sleep mode
+}
+
+uint8_t transfer(uint8_t val) {
+  delay(1);
+  PORTB &= ~(1<<0);  
+  uint8_t r = SPI.transfer(val);
+  PORTB |=  (1<<0);
+  
+  return r;
+}
+
+int probe() {
+  transfer(0x00);  // first transfer will cause a SPI error on TLE94108
+  uint8_t r = transfer(0x00);
+  
+  // test for MC33879: This simply returns 0x00
+  if(!r) return CHIP_MC33879;
+
+  // test for TLE94108: ignore undervoltage bit 4, all other bits should be
+  // zero except bit 0 which reports a SPI error as 0x00 is not a valid request
+  if((r & ~4) == 0x01) return CHIP_TLE94108;
+
+  // test for drv8908: The two upper bits are always 1, ignore undervoltage
+  // bit 4, all other bits should be zero
+  if((r & ~4) == 0xc0) return CHIP_DRV8908;
+  
+  return CHIP_UNKNOWN;
+}
+
+void setup() {
+  Serial.begin(115200);
+
+  driver_prepare();
+  
+  // wait a second for USB
+  uint32_t to = millis();
+  while(!Serial && millis()-to < 2000);
+
+  Serial.println("ftDuino output driver chip detector");
+  
+  // LED initialisieren
+  pinMode(LED_BUILTIN, OUTPUT);
+  
+  display.setTextColor(WHITE);
+
+  print_centered(1, 0, "Driver Detection");
+
+  chip = probe();
+  Serial.print("Chip: ");
+  Serial.println(names[chip]);
+
+  print_centered(2, 2, names[chip]);  
+
+  display.display();
+}
+
+void blink(int len) {
+  digitalWrite(LED_BUILTIN, HIGH);
+  delay(len);
+  digitalWrite(LED_BUILTIN, LOW);
+  delay(100);
+}
+
+void loop() {
+  blink(250);   // long
+  
+  // blink pattern if no display is connected
+  // n * short
+  for(char i=0;i<chip;i++)
+    blink(100);
+    
+  delay(1000);
+}

ftduino/libraries/FtduinoSimple/examples/ChipDetect/FtduinoDisplay.cpp

@@ -0,0 +1,132 @@
+#include "FtduinoDisplay.h"
+
+#define OLED_INIT
+
+#ifdef OLED_INIT
+static const uint8_t PROGMEM lcdBootProgram[] = {
+  // Cmd mode
+  0x00,
+
+  // Display Off
+  0xAE,
+
+  // Set Display Clock Divisor v = 0xF0
+  // default is 0x80
+  0xD5, 0xF0,
+
+  // Set Multiplex Ratio v = HEIGHT-1
+  0xA8, FTDDSP_HEIGHT-1,
+
+  // Set Display Offset v = 0
+  0xD3, 0x00,
+
+  // Set Start Line (0)
+  0x40,
+
+  // Charge Pump Setting v = enable (0x14)
+  // default is disabled
+  0x8D, 0x14,
+
+  // Set Segment Re-map (A0) | (b0001)
+  // default is (b0000)
+  0xA1,
+
+  // Set COM Output Scan Direction
+  0xC8,
+
+  // Set COM Pins v
+  0xDA, 0x02,
+
+  // Set Contrast v = 0x8F
+  0x81, 0x8F,
+
+  // Set Precharge = 0xF1
+  0xD9, 0xF1,
+
+  // Set VCom Detect
+  0xDB, 0x40,
+
+  // Entire Display ON
+  0xA4,
+
+  // Set normal/inverse display
+  0xA6,
+
+  // Display On
+  0xAF,
+
+  // set display mode = horizontal addressing mode (0x00)
+  0x20, 0x00,
+
+  // set col address range
+  0x21, 0x00, FTDDSP_WIDTH-1,
+
+  // set page address range
+  0x22, 0x00, 0x03
+};
+#endif
+
+uint8_t FtduinoDisplay::i2c_send_byte(uint8_t data) {
+  uint8_t timeout = 0;
+  TWDR = data;
+  TWCR = _BV(TWINT)  |  _BV(TWEN);
+  while(( !(TWCR & _BV(TWINT))) && ++timeout);
+  return timeout;
+}
+
+uint8_t FtduinoDisplay::i2c_start(void) {
+  TWCR = _BV(TWINT) | _BV(TWSTA)  | _BV(TWEN);
+  while( !(TWCR & _BV(TWINT)));
+
+  return i2c_send_byte(0x3C<<1);  // OLED I2C address
+}
+
+void FtduinoDisplay::i2c_stop(void) {
+  TWCR = _BV(TWINT) | _BV(TWEN) | _BV(TWSTO);
+  while( (TWCR & _BV(TWSTO)));
+}
+
+void FtduinoDisplay::i2c_send(uint16_t num, uint8_t *p) {
+  while(num--)
+    i2c_send_byte(*p++);
+}
+
+void FtduinoDisplay::i2c_send(uint16_t num, const uint8_t *p) {
+  while(num--)
+    i2c_send_byte(pgm_read_byte(p++));
+}
+
+FtduinoDisplay::FtduinoDisplay(void) :
+Adafruit_GFX(FTDDSP_WIDTH, FTDDSP_HEIGHT) {
+#ifdef OLED_INIT
+  // constructor
+  TWSR = 0;
+  TWBR = F_CPU/(2*400000)-8;
+
+  if(!i2c_start()) return; 
+  i2c_send(sizeof(lcdBootProgram), lcdBootProgram);
+  i2c_stop();
+#endif
+  TWBR = 1;
+  memset(buffer, 0, sizeof(buffer));
+}
+
+// the most basic function, set a single pixel
+void FtduinoDisplay::drawPixel(int16_t x, int16_t y, uint16_t color) {
+  if ((x < 0) || (x >= width()) || (y < 0) || (y >= height()))
+    return;
+
+  // x is which column
+  switch (color) {
+    case WHITE:   buffer[x+ (y/8)*FTDDSP_WIDTH] |=  (1 << (y&7)); break;
+    case BLACK:   buffer[x+ (y/8)*FTDDSP_WIDTH] &= ~(1 << (y&7)); break;
+    case INVERSE: buffer[x+ (y/8)*FTDDSP_WIDTH] ^=  (1 << (y&7)); break;
+  }
+}
+
+void FtduinoDisplay::display(void) {
+  i2c_start();
+  i2c_send_byte(0x40);  // data
+  i2c_send(512, buffer);
+  i2c_stop();
+}

ftduino/libraries/FtduinoSimple/examples/ChipDetect/FtduinoDisplay.h

@@ -0,0 +1,30 @@
+#ifndef _FTDUINO_DISPLAY_H_
+#define _FTDIUNO_DISPLAY_H_
+
+#include <Adafruit_GFX.h>
+
+#define FTDDSP_WIDTH 128
+#define FTDDSP_HEIGHT 32
+
+#define BLACK 0
+#define WHITE 1
+#define INVERSE 2
+
+class FtduinoDisplay : public Adafruit_GFX {
+  public:
+    FtduinoDisplay();
+    void drawPixel(int16_t x, int16_t y, uint16_t color);
+    void display();
+ 
+  private:  
+    uint8_t i2c_send_byte(uint8_t data);
+    uint8_t i2c_start(void);
+    void i2c_stop(void);
+    void i2c_send(uint16_t num, uint8_t *p);
+    void i2c_send(uint16_t num, const uint8_t *p);
+    
+    uint8_t buffer[FTDDSP_HEIGHT * FTDDSP_WIDTH / 8];
+};
+
+
+#endif // _FTDIUNO_DISPLAY_H_