Форум РадиоКот

Код: Выделить всё

input_voltage = SAR6_VIN_cGetSample(); //return 6 bit number - signed from PORT      
            
input_voltage = averaging_voltage(input_voltage);

char averaging_voltage( char voltage)
{
   static  char voltage_buffer[16];
   char avv; //averaging voltage
   int sum;
   
   static unsigned char index = 0 ;
   static unsigned char counter = 0 ;
   
   unsigned char i;
     
   voltage_buffer[index] = voltage;
   index++;
   index &= 0x0F; 
   
   for (i = 0; i < 16; i++)
   {
      if ((voltage_buffer[i] & 0x80) == 0x80)
      {
         sum -= ~voltage_buffer[i]+1;
      }
      else
      {      
         sum += voltage_buffer[i];
      }   
   }
      
   avv =(char)sum >> 4; //16
   
   avv = voltage;
   
   return avv;      
}

Код: Выделить всё

#include <stdio.h>

char SAR6_VIN_cGetSample()
{
   char a=0xE0;
   a&= ~(0xC0);// -32 в формате 6 бит знак минуса привязан к 6 биту
   return a; //-32

   //return 0x1F;//31
   /*
   Максимальное положительное число равно 31 0x1F
   Минимальное число равно -32 в формате 6 бит равно 0x20 в формате 8 бит 0xE0
   */
}

__int8 averaging_voltage(unsigned __int16 average)
{
   int a=0;
   for(unsigned __int16 i=0;i<average;i++)
   {
      __int8 adop=(__int8)SAR6_VIN_cGetSample();
      if(adop&(1<<5)) //проверка на наличие 6 бита  (минуса)
      {
         adop |= 0xC0; 
         a+=adop;
      }
      else
      {
         a+=adop;
      }
      
      //TIME
   }
   return (__int8)(a/(int)average);
}

int main()
{
   __int8 a;
   a=31;
   printf("HEX=%.2x DEX=%i\n",(unsigned __int8)a,a);
   a=0;
   printf("HEX=%.2x DEX=%i\n",(unsigned __int8)a,a);
   a=-32;
   printf("HEX=%.2x DEX=%i\n",(unsigned __int8)a,a);

   printf("HEX=%.2x DEX=%i\n",(unsigned __int8)SAR6_VIN_cGetSample(),SAR6_VIN_cGetSample());

   printf("average=%i\n",averaging_voltage(1000));
   getchar();
   
   return 0;
}
/*
HEX=1f DEX=31
HEX=00 DEX=0
HEX=e0 DEX=-32
HEX=20 DEX=32
average=-32
*/

Код: Выделить всё

int8_t get_sample();

// Первый вариант (простое арифметическе среднее).
int8_t get_average()
{
   int16_t acc;
   uint8_t i;
   
   for (acc = 0, i = 0; i < 16; i++)
   {
      acc += get_sample();
   }
      
   // Если кол-во выборок равно степени 2, то можно заменить на это
   // (если сдвиг вправо реализован как арифметический).
   // return (acc + 8) >> 4;
   return (acc + 8) / 16;
}

// Второй вариант (движущееся арифметическе среднее).
int8_t get_average(int8_t value)
{
   static uint8_t i = 0;   
   static int16_t acc = 0;
   static int8_t sample[16] = {0};
   
   acc -= sample[i];
   acc += value;
   sample[i] = value;
         
   
   // Если кол-во выборок равно степени 2, то можно заменить на это.
   // i = i + 1 & 15;
   if (++i >= 16)
      i = 0;
      
   // Если кол-во выборок равно степени 2, то можно заменить на это
   // (если сдвиг вправо реализован как арифметический).
   // return (acc + 8) >> 4;
   return (acc + 8) / 16;
}