make PWM duty cycle change more smoothly
[sensor-light.git] / msp430 / main.c
index 543022962a06b114721d3c7bb0cfadd34d40b06b..6b075ad91d6b9753f86cb258216d88227842d174 100644 (file)
@@ -6,7 +6,7 @@ enum {ev_btn1 = 0, ev_btn2, ev_pir1, ev_pir2, ev_tmr, ev_adc, ev_MAX};
 
 #define PWM_ORDER 10
 #define PWM_HALF 5
-#define LIGHT_THRESHOLD 200
+#define LIGHT_THRESHOLD 600
 #define TIME_ON 16
        
 #ifdef ADCSC /* Let us hope that this is a "new" model */
@@ -24,6 +24,14 @@ enum {ev_btn1 = 0, ev_btn2, ev_pir1, ev_pir2, ev_tmr, ev_adc, ev_MAX};
 # define BIT_BTN2 0
 #endif
 
+static int expon2(int duty)
+{
+       int shift = duty>>1;
+       int comp = 1<<shift;
+       int extra = (duty & 1) ? comp>>1 : 0;
+       return (duty ? comp|extra : 0);
+}
+
 int main(void)
 {
        int Duty_Cycle = 0;
@@ -114,10 +122,6 @@ int main(void)
                                P1OUT |= BIT_GL;        // Set green LED on
                        if (events & 1<<ev_pir2)
                                P1OUT |= BIT_RL;        // Set red LED on
-                       if (Duty_Cycle > 0) {
-                               Time_Left = TIME_ON;
-                               continue;
-                       }
                        // Sampling and conversion start
 #ifdef ADCENC
                        ADCCTL0 |= ADCENC | ADCSC;
@@ -131,8 +135,6 @@ int main(void)
                if (events & 1<<ev_adc) {
                        P1OUT ^= (BIT_GL|BIT_RL); // Flip green and red LEDs
                        Time_Indicate = 5;
-                       if (Time_Left)
-                               continue;
                        if (ADC_Result < LIGHT_THRESHOLD)
                                continue;
                        Time_Left = TIME_ON;
@@ -159,7 +161,7 @@ int main(void)
                                if (!Time_Indicate)
                                        P1OUT &= ~(BIT_RL|BIT_GL); // LEDs off
                        }
-                       if (Time_Count++ > 20) {
+                       if (Time_Count++ > 10) {
                                Time_Count = 0;
                                if (Time_Left)
                                        Time_Left--;
@@ -167,8 +169,8 @@ int main(void)
                                        Increment = -1;
                        }
                        if (Increment > 0) {
-                               if (++Duty_Cycle >= PWM_ORDER) {
-                                       Duty_Cycle = PWM_ORDER;
+                               if (++Duty_Cycle >= (PWM_ORDER<<1)) {
+                                       Duty_Cycle = PWM_ORDER<<1;
                                        Increment = 0;
                                }
                        } else if (Increment < 0) {
@@ -178,10 +180,8 @@ int main(void)
                                }
                        } else
                                continue;
-                       if (Duty_Cycle)
-                               TA0CCR2 = 1 << (Duty_Cycle - 1);
-                       else
-                               TA0CCR2 = 0;
+
+                       TA0CCR2 = expon2(Duty_Cycle);
                }
                __bis_SR_register(LPM0_bits | GIE);
                __no_operation();