/home/mrazik/Documents/web/old/hdo/main.c

Zobrazit dokumentaci tohoto souboru.

/* ----------------------------------------------------------------------------
 *         ATMEL Microcontroller Software Support
 * ----------------------------------------------------------------------------
 * Copyright (c) 2008, Atmel Corporation, Mrazík
 * ----------------------------------------------------------------------------
 */



















































//------------------------------------------------------------------------------



//------------------------------------------------------------------------------
//         Headers
//------------------------------------------------------------------------------

#include <board.h>
#include <pio/pio.h>
#include <pit/pit.h>
#include <dbgu/dbgu.h>
#include <aic/aic.h>
#include <utility/trace.h>
#include <utility/led.h>
#include <adc/adc.h>

#include <stdio.h>
#include "goertzel.h"
#include "hdo.h"

#define BOARD_ADC_FREQ 6000000

#define PIT_PERIOD          1000
//------------------------------------------------------------------------------
//         Local variables
//------------------------------------------------------------------------------

static const Pin pinsADC[] = {PINS_ADC};
static volatile unsigned int timestamp = 0;

static volatile unsigned int counter = 0;   
static short result;                        
static short buf_a [GOERTZEL_N];            
static short buf_b [GOERTZEL_N];            
static volatile int   pswitch = 0;          
static volatile int   change  = 0;          

#define ADC_NUM_1  ADC_CHANNEL_4
//------------------------------------------------------------------------------
//         Local functions
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
static void ISR_Pit (void) {
  unsigned int status;

  // Read the PIT status register
  status = PIT_GetStatus() & AT91C_PITC_PITS;
  if (status != 0) {
    // Read the PIVR to acknowledge interrupt and get number of ticks
    timestamp += (PIT_GetPIVR() >> 20);
  }
  ADC_EnableIt (AT91C_BASE_ADC, ADC_NUM_1);
    // Start measurement
  ADC_StartConversion (AT91C_BASE_ADC);
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
static void ISR_Adc (void) {
  unsigned int status;
  unsigned int id_channel = ADC_NUM_1;

  status = ADC_GetStatus (AT91C_BASE_ADC);
  TRACE_DEBUG ("status = 0x%X\n\r", status);

  if (ADC_IsChannelInterruptStatusSet (status, id_channel)) {

    TRACE_DEBUG ("channel %d\n\r", id_channel);
    ADC_DisableIt (AT91C_BASE_ADC, id_channel);
    result  = ADC_GetConvertedData (AT91C_BASE_ADC, id_channel);
    result -= 512;
    if (pswitch == 0) buf_a [counter] = result;
    else              buf_b [counter] = result;
    counter++;
    if (counter == GOERTZEL_N) {
      counter = 0;
      if (pswitch == 0) pswitch = 1;
      else              pswitch = 0;
      change = 1;
    }
  }
}

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
static void ConfigurePit (void) {
  // Initialize the PIT to the desired frequency
  PIT_Init (PIT_PERIOD, BOARD_MCK / 1000000);

  // Configure interrupt on PIT
  AIC_DisableIT (AT91C_ID_SYS);
  AIC_ConfigureIT (AT91C_ID_SYS, AT91C_AIC_PRIOR_LOWEST, ISR_Pit);
  AIC_EnableIT (AT91C_ID_SYS);
  PIT_EnableIT();

  // Enable the pit
  PIT_Enable();
}
//------------------------------------------------------------------------------
//         Global functions
//------------------------------------------------------------------------------

//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
int main (void) {
  char telegram [64];
  int  coeff;
  int  gresult;
  int  tmp;

  TRACE_CONFIGURE (DBGU_STANDARD, 115200, BOARD_MCK);
  printf ("-- ADC Projekt HDO %s --\n\r", SOFTPACK_VERSION);
  printf ("-- %s\n\r", BOARD_NAME);
  printf ("-- Compiled: %s %s --\n\r", __DATE__, __TIME__);

  LED_Configure (0);
  LED_Configure (1);
  LED_Configure (2);
  LED_Configure (3);

  PIO_Configure (pinsADC, PIO_LISTSIZE (pinsADC));

  ADC_Initialize (AT91C_BASE_ADC,
                  AT91C_ID_ADC,
                  AT91C_ADC_TRGEN_DIS,
                  0,
                  AT91C_ADC_SLEEP_NORMAL_MODE,
                  AT91C_ADC_LOWRES_10_BIT,
                  BOARD_MCK,
                  BOARD_ADC_FREQ,
                  10,
                  1200);

  ADC_EnableChannel (AT91C_BASE_ADC, ADC_NUM_1);

  ConfigurePit();

  AIC_ConfigureIT (AT91C_ID_ADC, 0, ISR_Adc);
  AIC_EnableIT (AT91C_ID_ADC);
  coeff = calc_coeff (0.2166);
  hdo_init (300);

  //printf ("-I- Press any key to perform a measurement on the ADC ...\n\r");

  // Wait for user input
  //DBGU_GetChar();

  // Infinite loop
  while (1) {

    if (pswitch == 0) {
      gresult = goertzel (coeff, buf_b, GOERTZEL_N);
      LED_Set (0);
    }
    else {
      gresult = goertzel (coeff, buf_a, GOERTZEL_N);
      LED_Clear (0);
    }
    if    ( change) TRACE_ERROR ("Nestiham !\r\n");
    while (!change);
    change = 0;

    tmp = tlg_decode (gresult, telegram);
    if (tmp) {
      printf (": %s\r\n", telegram);
    }
    if (tmp >= 0) {
      tmp = hdo_action (telegram, "A1B2DP2");
      if      (tmp == +1) LED_Set   (2);
      else if (tmp == -1) LED_Clear (2);
      tmp = hdo_action (telegram, "A1B2DP4");
      if      (tmp == +1) LED_Set   (3);
      else if (tmp == -1) LED_Clear (3);
    }
    if (gresult > 150) LED_Set   (1);
    else               LED_Clear (1);

    timestamp = 0;
  }
}