[dsPIC] PGA am ADC?

#include "system.h"

#include <xc.h>

#include <libpic30.h>

#include <stdio.h>

void SendUART(uint8_t data);

void SendUARTString(const char *str);

uint16_t ReadADC1();

uint16_t ReadADC2();

void __attribute__((interrupt, no_auto_psv)) _U1RXInterrupt()

{

    IFS0bits.U1RXIF = 0;

    uint8_t data = U1RXREG & 0xff;

    if (data == 'q')

    {

        uint16_t val = ReadADC2();

        char buffer[32];

        sprintf(buffer, "%d/4096\n", val);

        SendUARTString(buffer);

    }

    else if (data == 's')

    {

        uint16_t val = ReadADC1();

        char buffer[32];

        sprintf(buffer, "%d/4096\n", val);

        SendUARTString(buffer);

    }

}

void InitUART()

{

    // map pins

    RPINR18bits.U1RXR = 55; // uart receive pin = RC7

    RPOR9bits.RP50R = 1; // uart transmit pin = RC2

    // interrupt

    IEC0bits.U1RXIE = 1;

    IPC2bits.U1RXIP = 1;

    // init UART

    U1BRG = 64; // 57600 baud

    U1MODEbits.UARTEN = 1; // enable UART

    U1STAbits.UTXEN = 1; // enable TX

}

void SendUART(uint8_t data)

{

    while (U1STAbits.UTXBF);

    U1TXREG = data;

}

void SendUARTString(const char *str)

{

    while (*str)

        SendUART((uint8_t)*str++);

}

void InitPGA()

{

    PGA2CALbits.PGACAL = (uint8_t)__builtin_tblrdl(0x800E4C);

    PGA2CONbits.SELPI = 0; // PGA2P1

    PGA2CONbits.SELNI = 2; // PGA2N3

    PGA2CONbits.GAIN = 6; // x64

    PGA2CONbits.PGAEN = 1;

}

void CalibrateADC()

{

    // Set initialization time to maximum

    ADCON5Hbits.WARMTIME = 15;

    // Turn on ADC module

    ADCON1Lbits.ADON = 1;

    // Turn on analog power for dedicated core 1

    ADCON5Lbits.C1PWR = 1;

    // Wait when the core 1 is ready for operation

    while(ADCON5Lbits.C1RDY == 0);

    // Turn on digital power to enable triggers to the core 1

    ADCON3Hbits.C1EN = 1;

    // Turn on analog power for dedicated core 2

    ADCON5Lbits.C2PWR = 1;

    // Wait when the core 2 is ready for operation

    while(ADCON5Lbits.C2RDY == 0);

    // Turn on digital power to enable triggers to the core 2

    ADCON3Hbits.C2EN = 1;

    // Enable calibration for the dedicated core 1

    ADCAL0Lbits.CAL1EN = 1;

    // Single-ended input calibration

    ADCAL0Lbits.CAL1DIFF = 0;

    // Start calibration

    ADCAL0Lbits.CAL1RUN = 1;

    // Poll for the calibration end

    while(ADCAL0Lbits.CAL1RDY == 0);

    // Differential input calibration

    ADCAL0Lbits.CAL1DIFF = 1;

    // Start calibration

    ADCAL0Lbits.CAL1RUN = 1;

    // Poll for the calibration end

    while(ADCAL0Lbits.CAL1RDY == 0);

    // End the core 0 calibration

    ADCAL0Lbits.CAL1EN = 0;

    // Enable calibration for the dedicated core 2

    ADCAL0Hbits.CAL2EN = 1;

    // Single-ended input calibration

    ADCAL0Hbits.CAL2DIFF = 0;

    // Start calibration

    ADCAL0Hbits.CAL2RUN = 1;

    // Poll for the calibration end

    while(ADCAL0Hbits.CAL2RDY == 0);

    // Differential input calibration

    ADCAL0Hbits.CAL2DIFF = 1;

    // Start calibration

    ADCAL0Hbits.CAL2RUN = 1;

    // Poll for the calibration end

    while(ADCAL0Hbits.CAL2RDY == 0);

    // End the core 2 calibration

    ADCAL0Hbits.CAL2EN = 0;

}

void InitADC()

{

    CalibrateADC();

    //ADCORE2Hbits.ADCS = 10;

    // PGA 2 and AN2

    ADCON4Hbits.C1CHS = 2; // PGA2

    ADTRIG0Lbits.TRGSRC1 = 1;

    ADTRIG0Hbits.TRGSRC2 = 1;

}

uint16_t ReadADC1()

{

    ADCON3Lbits.CNVCHSEL = 1;

    ADCON3Lbits.CNVRTCH = 1;

    while (!ADSTATLbits.AN1RDY);

    return ADCBUF0;

}

uint16_t ReadADC2()

{

    ADCON3Lbits.CNVCHSEL = 2;

    ADCON3Lbits.CNVRTCH = 1;

    while (!ADSTATLbits.AN2RDY);

    return ADCBUF2;

}

int main()

{

    InitClock();

    InitUART();

    InitPGA();

    InitADC();

    for (;;)

    {

    }

}