Martin Cottrell / MicroBitPCA9685

microbit fork

Dependents:   demoMicroBit_PCA9685

Fork of PCA9685PWM by Paolo Sanna

MicroBitPCA9685.cpp@2:429b0b439bc1, 2017-01-13 (annotated)

Committer:
Asimov
Date:
Fri Jan 13 21:00:21 2017 +0000
Revision:
2:429b0b439bc1
Parent:
PCA9685.cpp@0:c7f4744deec3 
Just a copy

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Asimov 2:429b0b439bc1 1 #include "MicroBit.h"
Asimov 2:429b0b439bc1 2 #include "MicroBitPCA9685.h"
dreamworker 0:c7f4744deec3 3
Asimov 2:429b0b439bc1 4 MicroBitPCA9685::MicroBitPCA9685(MicroBitI2C& _i2c, uint8_t addr) : i2c(_i2c), _i2caddr(addr) {}
Asimov 2:429b0b439bc1 5
Asimov 2:429b0b439bc1 6 void MicroBitPCA9685::begin(void)
dreamworker 0:c7f4744deec3 7 {
dreamworker 0:c7f4744deec3 8 reset();
dreamworker 0:c7f4744deec3 9 }
dreamworker 0:c7f4744deec3 10
Asimov 2:429b0b439bc1 11 void MicroBitPCA9685::frequencyI2C(int freq)
dreamworker 0:c7f4744deec3 12 {
dreamworker 0:c7f4744deec3 13 i2c.frequency(freq);
dreamworker 0:c7f4744deec3 14 }
Asimov 2:429b0b439bc1 15 int MicroBitPCA9685::write8(uint8_t address, uint8_t data)
dreamworker 0:c7f4744deec3 16 {
dreamworker 0:c7f4744deec3 17 char cmd[2];
dreamworker 0:c7f4744deec3 18 cmd[0] = address;
dreamworker 0:c7f4744deec3 19 cmd[1] = data;
Asimov 2:429b0b439bc1 20 return i2c.write(_i2caddr, cmd, 2);
dreamworker 0:c7f4744deec3 21 }
dreamworker 0:c7f4744deec3 22
Asimov 2:429b0b439bc1 23 char MicroBitPCA9685::read8(char address)
dreamworker 0:c7f4744deec3 24 {
dreamworker 0:c7f4744deec3 25 i2c.write(_i2caddr, &address, 1);
dreamworker 0:c7f4744deec3 26 char rtn;
dreamworker 0:c7f4744deec3 27 i2c.read(_i2caddr, &rtn, 1);
dreamworker 0:c7f4744deec3 28 return rtn;
dreamworker 0:c7f4744deec3 29 }
dreamworker 0:c7f4744deec3 30
Asimov 2:429b0b439bc1 31 void MicroBitPCA9685::reset(void)
dreamworker 0:c7f4744deec3 32 {
dreamworker 0:c7f4744deec3 33 write8(PCA9685_MODE1, 0x0);
dreamworker 0:c7f4744deec3 34 }
Asimov 2:429b0b439bc1 35 void MicroBitPCA9685::setPrescale(uint8_t prescale) {
dreamworker 0:c7f4744deec3 36 uint8_t oldmode = read8(PCA9685_MODE1);
dreamworker 0:c7f4744deec3 37 uint8_t newmode = (oldmode&0x7F) | 0x10; // sleep
dreamworker 0:c7f4744deec3 38 write8(PCA9685_MODE1, newmode); // go to sleep
dreamworker 0:c7f4744deec3 39 wait_ms(5);
dreamworker 0:c7f4744deec3 40 write8(PCA9685_PRESCALE, prescale); // set the prescaler
dreamworker 0:c7f4744deec3 41 write8(PCA9685_MODE1, oldmode);
dreamworker 0:c7f4744deec3 42 wait_ms(5);
dreamworker 0:c7f4744deec3 43 write8(PCA9685_MODE1, oldmode | 0xa1);
dreamworker 0:c7f4744deec3 44 }
Asimov 2:429b0b439bc1 45 void MicroBitPCA9685::setPWMFreq(float freq)
dreamworker 0:c7f4744deec3 46 {
dreamworker 0:c7f4744deec3 47 float prescaleval = 25000000;
dreamworker 0:c7f4744deec3 48 prescaleval /= 4096;
dreamworker 0:c7f4744deec3 49 prescaleval /= freq;
dreamworker 0:c7f4744deec3 50 uint8_t prescale = floor(prescaleval + 0.5) - 1;
dreamworker 0:c7f4744deec3 51 setPrescale(prescale);
dreamworker 0:c7f4744deec3 52 }
dreamworker 0:c7f4744deec3 53
Asimov 2:429b0b439bc1 54 int MicroBitPCA9685::setPWM(uint8_t num, uint16_t on, uint16_t off)
dreamworker 0:c7f4744deec3 55 {
dreamworker 0:c7f4744deec3 56 char cmd[5];
dreamworker 0:c7f4744deec3 57 cmd[0] = LED0_ON_L + 4 * num;
dreamworker 0:c7f4744deec3 58 cmd[1] = on;
dreamworker 0:c7f4744deec3 59 cmd[2] = on >> 8;
dreamworker 0:c7f4744deec3 60 cmd[3] = off;
dreamworker 0:c7f4744deec3 61 cmd[4] = off >> 8;
Asimov 2:429b0b439bc1 62 return i2c.write(_i2caddr, cmd, 5);
dreamworker 0:c7f4744deec3 63 }
Asimov 2:429b0b439bc1 64
Asimov 2:429b0b439bc1 65
Asimov 2:429b0b439bc1 66
Asimov 2:429b0b439bc1 67
Asimov 2:429b0b439bc1 68 int MicroBitPCA9685::setAllPWM(uint16_t on, uint16_t off)
Asimov 2:429b0b439bc1 69 {
Asimov 2:429b0b439bc1 70 char cmd[5];
Asimov 2:429b0b439bc1 71 cmd[0] = ALLLED_ON_L;
Asimov 2:429b0b439bc1 72 cmd[1] = on;
Asimov 2:429b0b439bc1 73 cmd[2] = on >> 8;
Asimov 2:429b0b439bc1 74 cmd[3] = off;
Asimov 2:429b0b439bc1 75 cmd[4] = off >> 8;
Asimov 2:429b0b439bc1 76 return i2c.write(_i2caddr, cmd, 5);
Asimov 2:429b0b439bc1 77 }