Subversion Repositories Code-Repo

#include "defines.h"

#include "CPS.h"

static CPS_DATA *cps_data_p;

void CPS_Init(CPS_DATA* data) {

    cps_data_p = data;

    for (uint8_t i = 0; i < 4; i++) {

        cps_data_p->btn_pressed[i] = 0;

        cps_data_p->btn_last_value[i] = 0;

        cps_data_p->btn_avg_value[i] = 0;

        cps_data_p->btn_pct_value[i] = 0;

    }

    cps_data_p->channels[0] = 8;

    cps_data_p->channels[1] = 9;

    /* Initialize FVR for the upper threshold (Ref+) */

    FVRCONbits.CDAFVR = 0b01; // Gain of 1x (1.024V)

    FVRCONbits.FVREN = 1; // Enable FVR module

    /* Initialize DAC for the lower threshold (Ref-) to Vss */

    DACCON0bits.DACEN = 0; // Disable DAC

    DACCON0bits.DACLPS = 0; // Negative reference source selected

    DACCON0bits.DACOE = 0; // Output not routed to DACOUT pin

    DACCON0bits.DACPSS = 0b00; // Vss used as positive source

//    DACCON0bits.DACNSS = 0; // Vss used as negative source

    // Output voltage formula:

    //  V_out = ((V_source+ - V_source-) * (DACR / 32)) + V_source-

    DACCON1bits.DACR = 0b00000; // Voltage output set to 0v

//    /* Initialize DAC for the lower threshold (Ref-) to variable setting */

//    DACCON0bits.DACEN = 1; // Enable DAC

//    DACCON0bits.DACLPS = 1; // Positive reference source selected

//    DACCON0bits.DACOE = 0; // Output not routed to DACOUT pin

//    DACCON0bits.DACPSS = 0b10; // FVR buffer2 used as positive source

////    DACCON0bits.DACNSS = 0; // Vss used as negative source

//    // Output voltage formula:

//    //  V_out = ((V_source+ - V_source-) * (DACR / 32)) + V_source-

//    DACCON1bits.DACR = 0b10000; // Voltage output set to 0.512v

    /* Initialize Timer 0 */

    OPTION_REGbits.TMR0CS = 0; // Clock source is FOSC/4

    OPTION_REGbits.PSA = 0; // Prescaler enabled

    OPTION_REGbits.PS = 0b110; // Prescaler of 1:128

    /* Initialize Timer 1 */

    T1CONbits.TMR1CS = 0b11; // Clock source is Capacitive Sensing Oscillator

    T1CONbits.T1CKPS = 0b00; // 1:1 Prescale value

    T1GCONbits.TMR1GE = 1; // Counting is controlled by the gate function

    T1GCONbits.T1GPOL = 1; // Gate is active high

    T1GCONbits.T1GTM = 1; // Gate toggle mode is enabled

    T1GCONbits.T1GSPM = 0; // Gate single-pulse mode is disabled

    T1GCONbits.T1GSS = 0b01; // Gate source is Timer 0 overflow

    T1CONbits.TMR1ON = 1; // Enables timer 1

    /* Initialize CPS Module */

    CPSCON0bits.CPSRM = 1; // DAC and FVR used for Vref- and Vref+

    CPSCON0bits.CPSRNG = 0b11; // Osc in high range (100uA)

    CPSCON0bits.T0XCS = 0; // Timer 0 clock runs at FOSC/4

    CPSCON1 = cps_data_p->channels[0];

    cps_data_p->channel = 0;

    CPSCON0bits.CPSON = 1; // CPS module is enabled

    /* Initialize timer interrupts and clear timers */

    INTCONbits.TMR0IE = 1; // Timer 0 interrupt enabled

    PIE1bits.TMR1IE = 0; // Timer 1 interrupt disabled

    CPS_Reset();

}

void CPS_Timer_0_Interrupt_Handler() {

    uint16_t value = TMR1;

    int32_t percent;

    if (value < 10) {

        return;

    }

    // Calculate percentage change

    percent = (int32_t)cps_data_p->btn_avg_value[cps_data_p->channel]-(int32_t)value;

    if (percent < 0)

        percent = 0;

    else {

        percent *= 100;

        percent /= cps_data_p->btn_avg_value[cps_data_p->channel];

    }

    cps_data_p->btn_last_value[cps_data_p->channel] = value;

    cps_data_p->btn_pct_value[cps_data_p->channel] = percent;

    if (percent < CPS_PCT_OFF) {

        // Calculate average

        cps_data_p->btn_avg_value[cps_data_p->channel] +=

//            ((int32_t)value - (int32_t)cps_data_p->btn_avg_value[cps_data_p->channel])/CPS_AVG_COUNT;

            ((int32_t)value - (int32_t)cps_data_p->btn_avg_value[cps_data_p->channel]) >> 4;

        // Set flag to indicate that button is not pressed

        cps_data_p->btn_pressed[cps_data_p->channel] = 0;

    } else if (percent > CPS_PCT_ON) {

        // Set flag to indicate that button was pressed

        cps_data_p->btn_pressed[cps_data_p->channel] = 1;

    }

    cps_data_p->channel = cps_data_p->channel + 1;

    if (cps_data_p->channel == CPS_NUM_CHANNELS)

        cps_data_p->channel = 0;

    CPSCON1 = cps_data_p->channels[cps_data_p->channel];

    CPS_Reset();

}

void CPS_Reset() {

    TMR1 = 0;

    TMR0 = 0;

}

void CPS_Enable() {

    INTCONbits.TMR0IE = 1; // Timer 0 interrupt enabled

    T1CONbits.TMR1ON = 1;

    CPSCON0bits.CPSON = 1;

    CPS_Reset();

}

void CPS_Disable() {

    INTCONbits.TMR0IE = 0;

    CPSCON0bits.CPSON = 0;

    T1CONbits.TMR1ON = 0;

}