Diff: PCA9745B.cpp

Revision:

0:0f53e5add603

diff -r 000000000000 -r 0f53e5add603 PCA9745B.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/PCA9745B.cpp	Mon Jul 23 12:25:17 2018 +0000
@@ -0,0 +1,53 @@
+#include "mbed.h"
+#include "stdint.h"
+#include "PCA9745B.h"
+
+PCA9745B::PCA9745B(uint8_t number, PinName SCLK, PinName MOSI) : n(number), spi(MOSI, NC, SCLK)
+{
+    numdrivers = n;   
+    
+    // Configure SPI to 8 bits and SPI_SPEED  
+    spi.format(8, 0);
+    spi.frequency(SPI_SPEED);
+    
+    BCr = BCg = BCb = 0x7F;
+    pwmbuffer = (uint16_t *)calloc(2, 12*n);
+}
+
+void PCA9745B::write(void) {
+  uint32_t command;
+  // Magic word for write
+  command = 0x25;
+  command <<= 5;
+  //OUTTMG = 1, EXTGCK = 0, TMGRST = 1, DSPRPT = 1, BLANK = 0 -> 0x16
+  command |= 0x16;
+  command <<= 7;
+  command |= BCr;
+  command <<= 7;
+  command |= BCg;
+  command <<= 7;
+  command |= BCb;
+  for (uint8_t n=0; n<numdrivers; n++) {
+    spi.write(command >> 24);
+    spi.write(command >> 16);
+    spi.write(command >> 8);
+    spi.write(command);
+    // 12 channels per PCA9745B
+    for (int8_t c=11; c >= 0 ; c--) {
+      // 16 bits per channel, send MSB first
+      spi.write(pwmbuffer[n*12+c]>>8);
+      spi.write(pwmbuffer[n*12+c]);
+    }
+  }
+}
+
+void PCA9745B::setPWM(uint8_t chan, uint16_t pwm) {
+  if (chan > 12*numdrivers) return;
+  pwmbuffer[chan] = pwm;  
+}
+
+void PCA9745B::setLED(uint8_t lednum, uint16_t r, uint16_t g, uint16_t b) {
+  setPWM(lednum*3, r);
+  setPWM(lednum*3+1, g);
+  setPWM(lednum*3+2, b);
+}