Subversion Repositories EngineBay2

#include "plx.h"

#include "misc.h"

// with a dwell angle of 45 degrees , 4 cylinders and a maximum RPM of 5000

// freq = 5000/60 * 2 = 166Hz. Because the breaker might bounce , we accept the first pulse longer than 1/300 of a second as being a proper closure .

// the TIM2 counter counts in 10uS increments,

#define BREAKER_MIN (RPM_COUNT_RATE/300)

volatile char TimerFlag = 0;

// Rev counter processing from original RevCounter Project

unsigned int RPM_Diff = 0;

unsigned int RPM_Count_Latch = 0;

// accumulators

unsigned int RPM_Pulsecount = 0;

unsigned int RPM_FilteredWidth = 0;

unsigned int Coded_RPM = 0;

unsigned int Coded_CHT = 0;

/* USER CODE END PFP */

void ConfigureDMA(void) {

}

void plx_sendword(int x) {

        PutCharSerial(&uc1, ((x) >> 6) & 0x3F);

        PutCharSerial(&uc1, (x) & 0x3F);

}

void ProcessRPM(int instance) {

// compute the timer values

// snapshot timers

        unsigned long RPM_Pulsewidth;

        unsigned long RPM_Count_Val;

        __disable_irq(); // copy the counter value

        RPM_Count_Val = RPM_Count;

        __enable_irq();

// do calculations

// if there is only one entry, cannot get difference

        if (RPM_Count_Latch != RPM_Count_Val) {

                while (1) {

                        unsigned int base_time;

                        unsigned int new_time;

                        // if we are at N-1, stop.

                        unsigned int next_count = RPM_Count_Latch + 1;

                        if (next_count == RPM_SAMPLES) {

                                next_count = 0;

                        }

                        if (next_count == RPM_Count_Val) {

                                break;

                        }

                        base_time = RPM_Time[RPM_Count_Latch];

                        new_time = RPM_Time[next_count];

                        RPM_Count_Latch = next_count;

                        if (new_time > base_time) {

                                RPM_Pulsewidth = new_time - base_time; // not wrapped

                        } else {

                                RPM_Pulsewidth = new_time + (~base_time) + 1; // deal with wrapping

                        }

                        RPM_Diff += RPM_Pulsewidth;

                        // need to check if this is a long pulse. If it is, keep the answer

                        if (RPM_Pulsewidth > BREAKER_MIN) {

                                RPM_Pulsecount++; // count one pulse

                                RPM_FilteredWidth += RPM_Diff; // add its width to the accumulator

                                RPM_Diff = 0; // reset accumulator of all the narrow widths

                        }

                }

        }

        if (RPM_Pulsecount > 0) {

                // now have time for N pulses in clocks

                // need to scale by 19.55: one unit is 19.55 RPM

                // 1Hz is 60 RPM

                Coded_RPM = (30.0 / 19.55 * RPM_Pulsecount * RPM_COUNT_RATE)

                                / (RPM_FilteredWidth) + 0.5;

#if !defined MY_DEBUG

                // reset here unless we want to debug

                RPM_Pulsecount = 0;

                RPM_FilteredWidth = 0;

#endif

        }

// send the current RPM calculation

        plx_sendword(PLX_RPM);

        PutCharSerial(&uc1, instance);

        plx_sendword(Coded_RPM);

// this uses a MAX6675 which is a simple 16 bit read

// SPI is configured for 8 bits so I can use an OLED display if I need it

void ProcessCHT(int instance)

{

        uint8_t buffer[2];

                   HAL_GPIO_WritePin(SPI_NS_Temp_GPIO_Port, SPI_NS_Temp_Pin, GPIO_PIN_RESET);

                   HAL_SPI_Receive(&hspi1, buffer, 2, 2);

                   HAL_GPIO_WritePin(SPI_NS_Temp_GPIO_Port, SPI_NS_Temp_Pin, GPIO_PIN_SET);

                   uint16_t obs = (buffer[0]<<8)| buffer[1];

                   uint8_t  good = (obs & 4)==0;

                   if(good)

                   {

                   }

        plx_sendword(PLX_EGT);

        PutCharSerial(&uc1, instance);

        plx_sendword(Coded_CHT);

}

        ;   // Temp sensor port

        ; // PLX comms port

        ;  // Debug comms port

        ; // enable the ADC

        __HAL_RCC_TIM6_CLK_ENABLE()

        ;

     // check to see if we have any incoming data, copy and append if so, if no data then create our own frames.

                int c;

                char send = 0;

                // poll the  input for a stop bit or timeout

                if(PollSerial(&uc1))

                {

                  c = GetCharSerial(&uc1);

                  if (c != PLX_Stop)

                  {

                                PutCharSerial(&uc1,c); // echo all but the stop bit

                  } else { // must be a stop character

                                send = 1; // start our sending process.

                        }

                }

                // sort out auto-sending

                if (TimerFlag)

                {

                  if (NoSerialIn)

                  {

                        PutCharSerial(&uc1,PLX_Start);

                        send = 1;

                  }

                }

                if (send)

                {

                  send = 0;

                 ProcessRPM(0);

                 ProcessCHT(0);

                 PutCharSerial(&uc1,PLX_Stop);

        }