#include "isr.h"
+/* Optional brightness compensation. Pick zero or one */
+#define CEIL256
+#undef CEIL32
+
+#define MIN_PWM 4 /* PWM settings below this value do not illuminate the LED */
+
/* Initialize the RGB LED assembly. Outputs are zero, PWM is off. */
void rgb_init();
/* Turn on the rgb. Outputs are zero, or last values set by rgb_set(). */
-#define rgb_on() do { TMR2ON = 1; } while (0)
+#define rgb_on() (TMR2ON = 1)
/* Turn off the rgb, first setting outputs to zero. */
void rgb_off();
/* Set a PWM value for each color LED. 0=off, 255=full on. */
+#ifdef CEIL256
+extern const unsigned char pwm_table[];
+#define rgb_set(red, grn, blu, wht) do { \
+ unsigned char tmp; \
+ ndi(); /* FIXME: doesn't seem to fix flicker */ \
+ tmp = pwm_table[(red)]; \
+ CCPR3L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ tmp = pwm_table[(grn)]; \
+ CCPR2L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ tmp = pwm_table[(blu)]; \
+ CCPR4L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ tmp = pwm_table[(wht)]; \
+ CCPR1L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ nei(); \
+} while (0)
+#else
+#ifdef CEIL32
+extern const unsigned char pwm_table[];
#define rgb_set(red, grn, blu, wht) do { \
+ unsigned char tmp; \
ndi(); /* FIXME: doesn't seem to fix flicker */ \
- CCPR1L = (red); \
- CCPR2L = (grn); \
- CCPR3L = (blu); \
- CCPR4L = (wht); \
+ tmp = pwm_table[(red)] >> 3; \
+ CCPR3L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ tmp = pwm_table[(grn)] >> 3; \
+ CCPR2L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ tmp = pwm_table[(blu)] >> 3; \
+ CCPR4L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ tmp = pwm_table[(wht)] >> 3; \
+ CCPR1L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
nei(); \
} while (0)
+#else
+#define rgb_set(red, grn, blu, wht) do { \
+ unsigned char tmp; \
+ ndi(); /* FIXME: doesn't seem to fix flicker */ \
+ tmp = (red); \
+ CCPR3L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ tmp = (grn); \
+ CCPR2L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ tmp = (blu); \
+ CCPR4L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ tmp = (wht); \
+ CCPR1L = (tmp < MIN_PWM) ? MIN_PWM : tmp; \
+ nei(); \
+} while (0)
+#endif
+#endif
#endif