LGfiltr | Mbed

Users » Kovalev_D » Code » LGfiltr
Dmitry Kovalev / Mbed 2 deprecated LGfiltr
Fork of LGstaandart by Dmitry Kovalev
host/Source/App/main.c

Committer:: Kovalev_D
Date:: 2016-02-03
Revision:: 23:12e6183f04d4
File content as of revision 23:12e6183f04d4:

/****************************************Copyright (c)****************************************************
**--------------File Info---------------------------------------------------------------------------------
** File name:           main.c
** Last modified Date:  2011-10-24
** Last Version:        V1.00
** Descriptions:        The main() function
**
**--------------------------------------------------------------------------------------------------------
** Created by:          Electrooptica Incorp.
** Created date:        2011-08-22
** Version:             V1.00
** Descriptions:        
**--------------------------------------------------------------------------------------------------------       
*********************************************************************************************************/
#include "SIP.h"
#include "el_lin.h"
#include "CyclesSync.h"
#include "Parameters.h"							  
#include "Dither_Reg.h"
#include "commandset.h"
#include "CntrlGLD.h"
#include "InputOutput.h"
#include <math.h>
#include "stdlib.h"
#include "console.h"
#include "vibro.h"
#include "QEI.h"
#include "MTimer.h"
#include "Global.h"
#include "SPI.h"
#include "uart_m.h"
#include "command.h"
#include "Global.h"

///ÕÅÐÍß

/******************************************************************************
**   Main Function  main()
******************************************************************************/
extern uint32_t CMD_Mode;
//////////////////////////////////////////////////////////////////////////////////////////////////////////
//////////////////////////////////////////////////////////////////////////////////////////////////////////

				int i1 =0;
//extern unsigned int Buff_QEI[256];
volatile unsigned int IRQ_Counter=0;
volatile uint32_t timer1_counter = 0;
int temp111=0,temp=0;
int y = 0;
int CuruAngleOld=0;
unsigned int  LightUpCount,BackLightCount,secPuls,CountBI,CmmandIn,tt,th;


unsigned int paramV;




void Led_init()
{
	 LPC_PINCON->PINSEL0 = (0x00<<28);
	 LPC_GPIO1->FIODIR   = (0x1<<30);
	 LPC_PINCON->PINMODE0 = (0x3<<28);
	// LPC_GPIO1->FIOSET = (0x0<<30);
	// LPC_GPIO0->FIOSET = (1<<4);
}
int flag=0,  TIME=0,t=0, Sec=0,tmpSec=0,SEC=0, mSec=0;
int tempsec=0;
float DACF, K_DAC;
void Led_Blink()
{
	
	if (flag == 0)
	{
	LPC_GPIO1->FIOSET = (0x1<<30);
		flag=1;
	}
	else
	{
		flag =0;
		LPC_GPIO1->FIOCLR = (0x01<<30);
	}
}

long LED_TEMP=0;



int main (void)
{
 
{ 
	K_DAC=65535.0/(65535.0+(deltaDAC+deltaDAC/2));
  K_DAC=0.8;
	Main.Firmware_Version=0x15;
	Main.GLD_Serial = 0x20;
	Main.My_Addres=0;
	LightUpCount=1000;
	BackLightCount=5000;
	secPuls=0;
  Pulse_midl = 0;
  PulseHalf = 0;
  CuruAngle = 0;
	Spi.DAC_A=0x7fff;
	Spi.DAC_B=0x7fff;
  //èíèöèàëèçàöèÿ
  SystemInit();  // Èíèöèàëèçàöèÿ ñèñòåìû
  Led_init();

	///*
	//êîíôèãóðèðîâàíèå ñèãíàëà ïîäæèãà
  LPC_PINCON->PINSEL0 &= ~(3<<8);		//e. P0.4 is GPIO pin (çàïèñü ( 00 ) â 9:8 áèò PISEL0    âûáîð P0.4 êàê GPIO)
  LPC_PINCON->PINMODE0 |= (3<<8);		//e. P0.4 is GPIO pin (çàïèñü ( 11 ) â 9:8 áèò PINMODE0  "äëÿ âêëþ÷åíèÿ ïîäòÿãèâàþùåãî ðåçèñòîðà")
  LPC_GPIO0->FIODIR   |= (1<<4);		//e. P0.4 is output   (çàïèñü ( 1 ) â  5  áèò FIODIR    âûáîð P0.4 êàê âûõîä)
  LightUpON		//e. P0.4 is output   (çàïèñü ( 1 ) â  5  áèò CLR       óñòàíàâëèâàåì íà P0.4 íèçêèé óðîâåíü ñèãíàëà)
  /*
	LPC_PINCON->PINSEL0 &= ~(3<<10);		//e. P0.4 is GPIO pin (çàïèñü ( 00 ) â 9:8 áèò PISEL0    âûáîð P0.4 êàê GPIO)
  LPC_PINCON->PINMODE0 |= (3<<10);		//e. P0.4 is GPIO pin (çàïèñü ( 11 ) â 9:8 áèò PINMODE0  "äëÿ âêëþ÷åíèÿ ïîäòÿãèâàþùåãî ðåçèñòîðà")
  LPC_GPIO0->FIODIR   |= (1<<5);		//e. P0.4 is output   (çàïèñü ( 1 ) â  5  áèò FIODIR    âûáîð P0.4 êàê âûõîä)
  LPC_GPIO0->FIOCLR   |= (1<<5);		//e. P0.4 is output   (çàïèñü ( 1 ) â  5  áèò CLR       óñòàíàâëèâàåì íà P0.4 íèçêèé óðîâåíü ñèãíàëà)*/
///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////	
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
  
	LPC_PINCON->PINSEL3   = (0x00<<18);		//e. P1.25 is GPIO pin 
  LPC_PINCON->PINMODE3 |= (3<<18);		//e. P1.25  (âêëþ÷åíèe ïîäòÿãèâàþùåãî ðåçèñòîðà")
  LPC_GPIO1->FIODIR    |= (1<<25);		//e. P0.5 is output   (çàïèñü ( 1 ) â  5  áèò FIODIR    âûáîð P0.5 êàê âûõîä)
  LPC_GPIO1->FIOCLR    |= (1<<25);
	
	
/////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
	
	LPC_PINCON->PINSEL3   = (0x00<<24);		//e. P1.28 is GPIO pin 
  LPC_PINCON->PINMODE3 |= (3<<24);		//e. P1.28 is GPIO pin (çàïèñü ( 11 ) â áèò PINMODE0  "äëÿ âêëþ÷åíèÿ ïîäòÿãèâàþùåãî ðåçèñòîðà")
  LPC_GPIO1->FIODIR    |= (1<<28);		//e. P1.28 is output   (çàïèñü ( 1 ) â  5  áèò FIODIR    âûáîð P0.5 êàê âûõîä)
  LPC_GPIO1->FIOCLR    |= (1<<28);
//  init_timer(TIME_INTERVAL ); // 10ms	
 // enable_timer1();
///èÍÈöèàëèçàöèÿ ïîäñâåòêè
	LPC_PINCON->PINSEL2   = (0x00<<24);		//e. P2.12 is GPIO pin 
  LPC_PINCON->PINMODE3 |= (3<<24);		//e. P1.28 is GPIO pin (çàïèñü ( 11 ) â áèò PINMODE0  "äëÿ âêëþ÷åíèÿ ïîäòÿãèâàþùåãî ðåçèñòîðà")
  LPC_GPIO2->FIODIR    |= (1<<12);		//e. P1.28 is output   (çàïèñü ( 1 ) â  5  áèò FIODIR    âûáîð P0.5 êàê âûõîä)
  LPC_GPIO2->FIOCLR    |= (1<<12);
  
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////	
/*
  //êîíôèãóðèðîâàíèå ñèãíàëà ïîäæèãà îòîðâàíàÿ íîãà (ïîäæèã íà 80 íîãå âìåñòî 81)
  LPC_PINCON->PINSEL0   = (0x00<<10);		//e. P0.5 is GPIO pin (çàïèñü ( 00 ) â 11:10 áèò PISEL0    âûáîð P0.5 êàê GPIO)
  LPC_PINCON->PINMODE0 |= (3<<10);		//e. P0.5 is GPIO pin (çàïèñü ( 11 ) â 11:10 áèò PINMODE0  "äëÿ âêëþ÷åíèÿ ïîäòÿãèâàþùåãî ðåçèñòîðà")
  LPC_GPIO0->FIODIR    |= (1<<5);		//e. P0.5 is output   (çàïèñü ( 1 ) â  5  áèò FIODIR    âûáîð P0.5 êàê âûõîä)
  LPC_GPIO0->FIOCLR    |= (1<<5);		//e. P0.5 is output   (çàïèñü ( 1 ) â  5  áèò CLR       óñòàíàâëèâàåì íà P0.5 íèçêèé óðîâåíü ñèãíàëà)
	*/
  DMA_Init();           // Èíèöèàëèçàöèÿ DMA
  FlashDMA_Init(); 			// Çàãðóçêà ïàðàìåòðîâ ñ ôëýø
  
  SystemCoreClockUpdate();  // ðàñ÷åò ñèñòåìíîé ÷àñòîòû äëÿ UART.
  UARTInit();				        // èíèöèàëèçàöèÿ  UART0 íà ñêîðîñòü 38400.
  UART1_Init();             // èíèöèàëèçàöèÿ  UART1 íà ñêîðîñòü 38400.
	
	
  DAC_ADC_Exchange_Init();  // èíèöèàëèçàöèÿ  îáìåíà ÀÖÏ è ÖÀÏ.
	DACInit();                // èíèöèàëèçàöèÿ ÖÀÏ.
  SOI_Init(); 			      	// Èíèöèàëèçàöèÿ êâàäðàòóðíîãî ýíêîäåðà.
 
  IntLatch_Init();			// èíèöèàëèçàöèÿ âíóòðåííåé çàùåëêè.
  ExtLatch_Init();			// èíèöèàëèçàöèÿ âíåøíåé çàùåëêè.

//----------------debug------------------------- 
  //LPC_GPIO2->FIODIR = 0x5C;		// P2.0...P2.7 defined as Outputs 
  //LPC_GPIO2->FIOCLR = 0x5C;		// turn off all the LEDs 
//----------------debug------------------------- 
 

    LoadFlashParam(FromFLASH); 	//çàãðóçêà ïàðàìåòðîâ.
    UART_DMA_Init();			    	//èíèöèàëèçàöèÿ DMA äëÿ UART.
    G_Photo_Init();				      //èíèöèàëèçàöèÿ èíòåðôåéñà I2C äëÿ ôîòîäåòåêòîðà.
    Out_G_photo(60, 60);        //çàïèñü â áóôåð ìàñòåðà ïðèíÿòûå îò ôóíêöèè äàííûå (60,60) è óñòàíîâêà ôëàãà ñòàðòà ïåðåäà÷è è çàíÿòîé øèíû.
//  WDTInit();


  	open_all_loops();                          //#define open_all_loops()			RgConA   = 0	(Îñíîâíîé ðåãèñòð óïðàâëåíèÿ óñòðîéñòâà (0 - âêëþ÷èòü, 1 - îòêëþ÷èòü)).
  	Output.Str.HF_reg = Device_blk.Str.HF_min; //HFO output voltage = ìàêñèâàëüíîå íàïðÿæåíèå íà ÃÂ×.
   	init_PLC();                                //Èíèöèàëèçàöèÿ ÑÐÏ(ðåãóëèðîâêà ïåðèìåòðà)
   	init_Dither_reg();                         //èíèöèàëèçàöèÿ âèáðîïðèâîäà
  	RgConB = RATE_VIBRO_1; // äîïîëíèòåëüíûé ðåãèñòð óïðàâëåíèÿ = ðàçíîñòü âèáðîñ÷åò÷èêîâ ïîñëå ôèëüòðà ñêîëüç.ñðåäíåãî(#define RATE_VIBRO_1	0x0001)
	  init_Vibro();
		init_timer(TIME_INTERVAL ); // 10ms	
    enable_timer1();
    Init_TIM2();
    enable_timer2();
    close_all_loops();
		
		LPC_GPIO0->FIOCLR = (1<<5);
 }	 

 
	Pulse_8Point = 0;
	Pulse_16Point = 0;
	Pulse_32Point = 0;

  Temp_AMP=0;
	Temp_ADC_2=0;
	Temp_ADC_3=0;
	Temp_ADC_4=0;
	Temp_ADC_5=0;
     

 
for (y = 0; y < 256; y++ ) 
 {
	 Buff_16Point [y] = 0xffff;
	 Buff_8Point [y] = 0xffff;
	 Buff_32Point [y] = 0xffff;
	    Buff_ADC_1	[y] = 0;// àìïë àöï.
	    Buff_ADC_2	[y] = 0;
			Buff_ADC_3	[y] = 0;
			Buff_ADC_4	[y] = 0;
			Buff_ADC_5	[y] = 0;
	
 }

 

SendToBuffStr ("\n\r ....... ");
OutBufConCount =0;
 WriteCon("\n\r ...WriteCon1.... ");
 do //îñíîâíîé öèêë.
	  {
		

		if (OutBufConCount)  OutBufConCount--;	
		Concol ();
 //   Concol1 ();
     Read_CMD();
	
			//	VibroOut();

  
	   	if(Time_1kHz>100)
			{
				
        SEC++;
				if(Rate_Flag==1&&SEC>500)
				{
				SEC-=500;
				CMD_Rate();
				}
		  	
				Time_1kHz-=100;
				if(LightUpCount){LightUpCount--;LightUpON}
				
				else
				{
					LightUpOFF;
				}
				if(BackLightCount){BackLightCount--;BackLightON}
				else
				{
					BackLightOFF;
				}
			}
			ButtonLightUP();
		  //Device_blk.Str.
    TakeFromBuff();
			
	    //îòêëþ÷åíèå ïîäæèãà.
  
	    // paramV=TakeParam(1);

	



			if (LPC_PWM1->IR & 0x0001) // Åñëè â ðåãèñòðå ïðåðûâàíèé ØÈÌ1 (ðåãèñòð PWM1IR) åñòü âëàã ïðåðûâàíèÿ ñîâïàäåíèÿ ñ÷åò÷èêà ñ ÌÀÒÑÍ (lim0 ?) òî:
	   { 	
	/*	ResetCS(ADC);					  	 //prepare ADC for sampling
		SetDAC(DAC);		
    LPC_GPIO2->FIOSET |= 0x0000004;		// turn on the LED
    LPC_GPIO2->FIOSET |= 0x0000004;		// turn on the LED
    LPC_GPIO2->FIOSET |= 0x0000004;		// turn on the LED			 
		SetCS(ADC);					    		//start ADC sampling
		ResetDAC(DAC);  	    			//start DAC prepearing for writing

*/			 
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////   
			

              secPuls++;
        			tmpSec++;
			       	mSec++;  
						
		i1++;
		if(i1>10000)
		//if(CountV31>30)	
			{
			i1=0;
					/*	
					SendToBuffStr("\n\r");
				 	//	if (Buff_ADC_1	[y] > 65535)SendToBuffStr(" 0 "); else SendToBuffStr(" 1 ");
				  sprintf (BuffTemp,"<%05d> <%05d> <%05d> <%05d> <%05d>", Temp_AMP>>5,Temp_ADC_2>>5,Temp_ADC_3>>5,Temp_ADC_4>>5,Temp_ADC_5>>5); 
				 // sprintf (BuffTemp,"<%07d> <%07d> <%07d> <%07d> <%07d>", Spi.ADC1,Spi.ADC2,Spi.ADC3,Spi.ADC4,Spi.ADC5); 
						SendToBuffStr(BuffTemp);
				    */
				      /*
				      WriteConByte (Main.T_Vib&0xff00);
			        WriteConByte (Main.T_Vib&0x00ff);
			      	WriteConByte (Main.T_Vib);
				 */
				/*

				for (y = 0; y < 32; y++ )
							{
    					 
						  	 WriteCon(BuffTemp);
							}	WriteCon("\n\r");	
				
				*/		
/*
Main.T_Vib=((7680000*16/Main.Frq)*4096);
         th=   Main.T_Vib&0xff00;
         tt=   Main.T_Vib&0x00ff;
            sprintf(BuffTemp,"<%07d  >",( (Main.T_Vib&0xff00)));
						SendToBuffStr(BuffTemp);
						
						sprintf(BuffTemp,"<%07d  >",( ( Main.T_Vib&0x00ff)));
						SendToBuffStr(BuffTemp);
						/*
						CuruAngleOld=CuruAngle;*/
				    // Spi.ADC1=Spi.ADC1*0.000061;
				
				
			
				
				/*
				
				   	sprintf(BuffTemp,"\n\r<%05d><%05d><%05d><%05d><%05d>",Spi.ADC1,Spi.ADC2,Spi.ADC3,Spi.ADC4,Spi.ADC5);
		       	SendToBuffStr(BuffTemp);
				
				*/
				
					/*	sprintf(BuffTemp,"<%d>",(FrecTemp));
						SendToBuffStr(BuffTemp);
				for (y = 0; y < 32; y++ )
		   		{
						sprintf(BuffTemp,"   <%07d>", (Buff_16PointD [y]-65535));
						SendToBuffStr(BuffTemp);
					}		*/							
      }
		
		
	 
			 




//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////



						
		LPC_GPIO2->FIOSET |= 0x0000004;		// turn on the LED 

	
		Curr_Cnt_Vib = LPC_QEI->POS;		// çàïèñàòü â ïåðåìåííóþ	Curr_Cnt_Vib òåêóùåå ïîëîæåíèå Ýíêîäåðà.	(òåêóùåå êîëè÷åñòâî èìïóëüñîâ)
		Latch_Event(); //îïðåäåëåíèå çàùåëêè
		
	 	clc_Pulses(); // ñ÷åò÷èê èìïóëüñîâ. RATE_REPER_OR_REFMEANDR èëè RATE_VIBRO_1
		
	
		//ADC_Input();  // ïðîâåðêà ôëàãîâ çàïîëíåíèÿ áóôåðà è ÷åòåíèå Thermo1, Thermo2, HF_out â ìàñèâ  Input.ArrayIn[n].
	//DAC_ADC_Exchange();//  ïðîâåðêà ôëàãîâ çàïîëíåíèÿ áóôåðà è çïèñü â ÖÀÏû. 
		ServiceTime();//ñåêóíäíûé òàéìåð.
	 	clc_ThermoSensors();//ðàñ÷åò ñðåäíåé òåìïåðàòóðû çà ñåêóíäó	 
	 	clc_HFO(); //ðàñ÷åò çíà÷åíèÿ äëÿ ïåðåäà÷è â êîíòóð ÃÂ×(íà öàï).
	 	clc_PLC();	  
	 //	clc_Dith_regulator(); 
	 	clc_OutFreq_regulator();
	 	Output.Str.WP_sin = clc_WP_sin();  	
	 	contrl_GLD(); 
   	G_Photo_Exchange();	
	//  Output.Str.T_Vibro = paramV*48;


	Line_1_Rcv();
 	decode_CMD(); 
  transm_DAT();  

		
//		data_Rdy &= ~RESET_PERIOD;


LPC_PWM1->IR = 0x0001;				 //e. clear interrupt flag 	



LPC_GPIO2->FIOCLR |= 0x0000004;		// turn off the LED 
//		WDTFeed();
		  
		
//SPI_Exchange();
   
	   }
		 
	  }	while ( 1 );	    // main infinie loop            
}

/******************************************************************************
**                            End Of File
******************************************************************************/
Repository toolbox

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	09 Jan 2018
Imports:	4
Forks:	0
Commits:	233
Dependents:	0
Dependencies:	1
Followers:	1
Important changes to repositories hosted on mbed.com

host/Source/App/main.c

File content as of revision 23:12e6183f04d4:

Repository toolbox

Repository details

Important Information for this Arm website

Important changes to repositories hosted on mbed.com

host/Source/App/main.c

File content as of revision 23:12e6183f04d4:

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning
