Jackson Lv / PWM_RGB

using PWM to control RGB LED for RedBear Demo

ChainableLED.cpp@0:22cae1dee34b, 2016-04-11 (annotated)

Committer:
Jackson_lv
Date:
Mon Apr 11 04:19:53 2016 +0000
Revision:
0:22cae1dee34b
using PWM to control RGB LED for RedBear BLE Nano

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jackson_lv 0:22cae1dee34b 1 /*
Jackson_lv 0:22cae1dee34b 2 * Copyright (C) 2013 Seeed Technology Inc.
Jackson_lv 0:22cae1dee34b 3 * Copyright (C) 2012 Paulo Marques (pjp.marques@gmail.com)
Jackson_lv 0:22cae1dee34b 4 *
Jackson_lv 0:22cae1dee34b 5 * Permission is hereby granted, free of charge, to any person obtaining a copy of
Jackson_lv 0:22cae1dee34b 6 * this software and associated documentation files (the "Software"), to deal in
Jackson_lv 0:22cae1dee34b 7 * the Software without restriction, including without limitation the rights to
Jackson_lv 0:22cae1dee34b 8 * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
Jackson_lv 0:22cae1dee34b 9 * the Software, and to permit persons to whom the Software is furnished to do so,
Jackson_lv 0:22cae1dee34b 10 * subject to the following conditions:
Jackson_lv 0:22cae1dee34b 11 *
Jackson_lv 0:22cae1dee34b 12 * The above copyright notice and this permission notice shall be included in all
Jackson_lv 0:22cae1dee34b 13 * copies or substantial portions of the Software.
Jackson_lv 0:22cae1dee34b 14 *
Jackson_lv 0:22cae1dee34b 15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
Jackson_lv 0:22cae1dee34b 16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
Jackson_lv 0:22cae1dee34b 17 * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
Jackson_lv 0:22cae1dee34b 18 * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
Jackson_lv 0:22cae1dee34b 19 * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
Jackson_lv 0:22cae1dee34b 20 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
Jackson_lv 0:22cae1dee34b 21 */
Jackson_lv 0:22cae1dee34b 22
Jackson_lv 0:22cae1dee34b 23 /* Information about the P9813 protocol obtained from:
Jackson_lv 0:22cae1dee34b 24 * http://www.seeedstudio.com/wiki/index.php?title=Twig_-_Chainable_RGB_LED
Jackson_lv 0:22cae1dee34b 25 *
Jackson_lv 0:22cae1dee34b 26 * HSB to RGB routine adapted from:
Jackson_lv 0:22cae1dee34b 27 * http://mjijackson.com/2008/02/rgb-to-hsl-and-rgb-to-hsv-color-model-conversion-algorithms-in-javascript
Jackson_lv 0:22cae1dee34b 28 *
Jackson_lv 0:22cae1dee34b 29 * This library is ported from Arduino to mbed
Jackson_lv 0:22cae1dee34b 30 */
Jackson_lv 0:22cae1dee34b 31
Jackson_lv 0:22cae1dee34b 32
Jackson_lv 0:22cae1dee34b 33 // --------------------------------------------------------------------------------------
Jackson_lv 0:22cae1dee34b 34
Jackson_lv 0:22cae1dee34b 35 #include "ChainableLED.h"
Jackson_lv 0:22cae1dee34b 36
Jackson_lv 0:22cae1dee34b 37 // Forward declaration
Jackson_lv 0:22cae1dee34b 38 float hue2rgb(float p, float q, float t);
Jackson_lv 0:22cae1dee34b 39 PwmOut PWMR(P0_11);
Jackson_lv 0:22cae1dee34b 40 PwmOut PWMG(P0_9);
Jackson_lv 0:22cae1dee34b 41 PwmOut PWMB(P0_10);
Jackson_lv 0:22cae1dee34b 42 // --------------------------------------------------------------------------------------
Jackson_lv 0:22cae1dee34b 43
Jackson_lv 0:22cae1dee34b 44 ChainableLED::ChainableLED(PinName r_pin, PinName g_pin, PinName b_pin,unsigned int number_of_leds) :
Jackson_lv 0:22cae1dee34b 45 _r_pin(r_pin), _g_pin(g_pin),_b_pin(b_pin)
Jackson_lv 0:22cae1dee34b 46 {
Jackson_lv 0:22cae1dee34b 47 _num_leds = number_of_leds;
Jackson_lv 0:22cae1dee34b 48
Jackson_lv 0:22cae1dee34b 49
Jackson_lv 0:22cae1dee34b 50 for (uint8_t i=0; i<_num_leds; i++)
Jackson_lv 0:22cae1dee34b 51 setColorRGB(i, 0, 0, 0);
Jackson_lv 0:22cae1dee34b 52 }
Jackson_lv 0:22cae1dee34b 53
Jackson_lv 0:22cae1dee34b 54 ChainableLED::~ChainableLED()
Jackson_lv 0:22cae1dee34b 55 {
Jackson_lv 0:22cae1dee34b 56 }
Jackson_lv 0:22cae1dee34b 57
Jackson_lv 0:22cae1dee34b 58 // --------------------------------------------------------------------------------------
Jackson_lv 0:22cae1dee34b 59
Jackson_lv 0:22cae1dee34b 60
Jackson_lv 0:22cae1dee34b 61
Jackson_lv 0:22cae1dee34b 62 void ChainableLED::sendColor(uint8_t red, uint8_t green, uint8_t blue)
Jackson_lv 0:22cae1dee34b 63 {
Jackson_lv 0:22cae1dee34b 64 //control the RGB LED by PWM
Jackson_lv 0:22cae1dee34b 65 PWMR = (float)red/255;
Jackson_lv 0:22cae1dee34b 66 PWMG = (float)green/255;
Jackson_lv 0:22cae1dee34b 67 PWMB = (float)blue/255;
Jackson_lv 0:22cae1dee34b 68
Jackson_lv 0:22cae1dee34b 69 }
Jackson_lv 0:22cae1dee34b 70
Jackson_lv 0:22cae1dee34b 71 void ChainableLED::setColorRGB(unsigned int led, float red, float green, float blue)
Jackson_lv 0:22cae1dee34b 72 {
Jackson_lv 0:22cae1dee34b 73 sendColor(0xff-red, 0xff-green, 0xff-blue );
Jackson_lv 0:22cae1dee34b 74 }
Jackson_lv 0:22cae1dee34b 75
Jackson_lv 0:22cae1dee34b 76 void ChainableLED::setColorHSB(unsigned int led, float hue, float saturation, float brightness)
Jackson_lv 0:22cae1dee34b 77 {
Jackson_lv 0:22cae1dee34b 78 float r, g, b;
Jackson_lv 0:22cae1dee34b 79
Jackson_lv 0:22cae1dee34b 80 if(saturation == 0.0)
Jackson_lv 0:22cae1dee34b 81 {
Jackson_lv 0:22cae1dee34b 82 r = g = b = brightness;
Jackson_lv 0:22cae1dee34b 83 }
Jackson_lv 0:22cae1dee34b 84 else
Jackson_lv 0:22cae1dee34b 85 {
Jackson_lv 0:22cae1dee34b 86 float q = brightness < 0.5 ?
Jackson_lv 0:22cae1dee34b 87 brightness * (1.0 + saturation) : brightness + saturation - brightness * saturation;
Jackson_lv 0:22cae1dee34b 88 float p = 2.0 * brightness - q;
Jackson_lv 0:22cae1dee34b 89 r = hue2rgb(p, q, hue + 1.0/3.0);
Jackson_lv 0:22cae1dee34b 90 g = hue2rgb(p, q, hue);
Jackson_lv 0:22cae1dee34b 91 b = hue2rgb(p, q, hue - 1.0/3.0);
Jackson_lv 0:22cae1dee34b 92 }
Jackson_lv 0:22cae1dee34b 93
Jackson_lv 0:22cae1dee34b 94 setColorRGB(led, (uint8_t)(255.0*r), (uint8_t)(255.0*g), (uint8_t)(255.0*b));
Jackson_lv 0:22cae1dee34b 95 }
Jackson_lv 0:22cae1dee34b 96
Jackson_lv 0:22cae1dee34b 97 // --------------------------------------------------------------------------------------
Jackson_lv 0:22cae1dee34b 98
Jackson_lv 0:22cae1dee34b 99 float hue2rgb(float p, float q, float t)
Jackson_lv 0:22cae1dee34b 100 {
Jackson_lv 0:22cae1dee34b 101 if (t < 0.0)
Jackson_lv 0:22cae1dee34b 102 t += 1.0;
Jackson_lv 0:22cae1dee34b 103 if(t > 1.0)
Jackson_lv 0:22cae1dee34b 104 t -= 1.0;
Jackson_lv 0:22cae1dee34b 105 if(t < 1.0/6.0)
Jackson_lv 0:22cae1dee34b 106 return p + (q - p) * 6.0 * t;
Jackson_lv 0:22cae1dee34b 107 if(t < 1.0/2.0)
Jackson_lv 0:22cae1dee34b 108 return q;
Jackson_lv 0:22cae1dee34b 109 if(t < 2.0/3.0)
Jackson_lv 0:22cae1dee34b 110 return p + (q - p) * (2.0/3.0 - t) * 6.0;
Jackson_lv 0:22cae1dee34b 111
Jackson_lv 0:22cae1dee34b 112 return p;
Jackson_lv 0:22cae1dee34b 113 }