Dmitry Kovalev
/
LGstaandart
forkd
Fork of LG2 by
Diff: host/Source/App/InputOutput.c
- Revision:
- 23:12e6183f04d4
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/host/Source/App/InputOutput.c Wed Feb 03 10:44:42 2016 +0300 @@ -0,0 +1,316 @@ +#include "InputOutput.h" +#include "CyclesSync.h" +#include "lpc17xx.h" +//-------------------temp------- +#include "el_lin.h" +INPUT Input; +OUTPUT Output; + +volatile uint32_t I2CMasterState = I2C_IDLE; +volatile uint32_t I2CMasterBuffer[I2C_WRITELENGTH]; + +int ExchangeErr = 0; +//----------------------temp--------------------- +extern char test; +/****************************************************************************** +** Function name: G_Photo_Exchange +** +** Descriptions: Driver for I2C exchange +** +** parameters: None +** Returned value: None +** +******************************************************************************/ + +void G_Photo_Exchange(void) +{ + uint32_t StatValue; + static uint32_t WrIndex; + static int32_t time_out = TIMEOUT; + + if (I2CMasterState) + return; //e.transmitting is not active, go away + + if (--time_out < 0) //e. valid time period elapsed, go away + { + time_out = TIMEOUT; + I2CMasterState = I2C_IDLE; //e. timer elapsed, go away + LPC_I2C0->CONSET = I2CONSET_STO; //e. Set Stop flag + LPC_I2C0->CONCLR = I2CONCLR_AAC | I2CONCLR_SIC | I2CONCLR_STAC; + return; + } + else if (!(LPC_I2C0->CONSET & I2CONSET_SI)) //e. state of I2C bus has not been changed + return; + + StatValue = LPC_I2C0->STAT; + + switch ( StatValue ) + { + case 0x08: // A Start condition is issued (write data for the first potentiometer) + WrIndex = 0; + time_out = TIMEOUT; //e. enable countdown + LPC_I2C0->DAT = I2CMasterBuffer[WrIndex++]; //e. send address + LPC_I2C0->CONCLR = (I2CONCLR_SIC | I2CONCLR_STAC); //e .clear interrupt bit and start bit + break; + + case 0x10: // A repeated started is issued (write data for the second potentiometer) + LPC_I2C0->DAT = I2CMasterBuffer[WrIndex++]; //e. send address + LPC_I2C0->CONCLR = (I2CONCLR_SIC | I2CONCLR_STAC); //e .clear interrupt bit and start bit + break; + + case 0x18: //e. Regardless, it's a ACK after slave address reading + LPC_I2C0->DAT = I2CMasterBuffer[WrIndex++]; //e. send another byte + LPC_I2C0->CONCLR = I2CONCLR_SIC; //e. clear interrupt bit + break; + + case 0x28: //e. Regardless it's a ACK after data byte + if (WrIndex == I2C_WRITELENGTH) //e. we have transmitted the data for the B potentiometer + { + I2CMasterState = I2C_IDLE; + LPC_I2C0->CONSET = I2CONSET_STO; //e. Set Stop flag + Output.Str.Cnt_Dif = 300; + } + else if (WrIndex == 3) + { + LPC_I2C0->CONSET = I2CONSET_STA; + Output.Str.Cnt_Dif = 200; + } + else + { + LPC_I2C0->DAT = I2CMasterBuffer[WrIndex++]; //e. send another byte + Output.Str.Cnt_Dif = 100; + } + LPC_I2C0->CONCLR = I2CONCLR_SIC; //e. clear interrupt bit + break; + + case 0x20: //e. no aknowledgement after address transmitting + case 0x30: //e. no aknowledgement after data block transmitting + LPC_I2C0->CONSET = I2CONSET_STO; //e. Set Stop flag + LPC_I2C0->CONCLR = (I2CONCLR_SIC | I2CONCLR_STAC); + I2CMasterState = I2C_IDLE; //e. fix new state + break; + } + return; +} +/****************************************************************************** +** Function name: DAC_ADC_Exchange +** +** Descriptions: Loading data to DACs and initialization of ADC reading +** +** parameters: None +** Returned value: None +** +******************************************************************************/ +void DAC_ADC_Exchange() +{ + //-------------------------loading data from ADC to buffer--------------------------------------- +//int x; + ExchangeErr &= ~ADC_ERR_MSK; //e. ñáðîñèòü ôëàã îøèáêè + if (LPC_SSP0->SR & SSP_BUSY) //e. åñëè áóôåð ïåðåäàò÷èêà íå ïîëîí + { + ExchangeErr |= ADC_ERR_MSK; //e. óñòàíîâèòü ôëàã îøèáêè + } + else + { + LPC_SSP0->DR = 0x8001; //çàïèñàòü 0x8001 â ðåãèñòð ïåðåäà÷è. + if (Sys_Clock & 1)//åñëè íå÷åòíûé òàêò òî + { + LPC_SSP0->DR = WRITE_DAC0; //e.êîìàíäà äëÿ ÖÀÏ_0 ïåðåäàâàòü. + LPC_SSP0->DR = (-Output.ArrayOut[3]+32767); //e. ïåðåäà÷à 12 áèò + } + else //åñëè òàêò ÷åòíûé. + { + LPC_SSP0->DR = WRITE_DAC1 ; //e.êîìàíäà äëÿ ÖÀÏ_1 ïåðåäàâàòü. + LPC_SSP0->DR = (Output.ArrayOut[0]<<1) & 0xFFF0; //e. ïåðåäà÷à 12 áèò + } + } +} +/****************************************************************************** +** Function name: ADC_Input +** +** Descriptions: Reading data from ADC +** +** parameters: None +** Returned value: None +** +******************************************************************************/ +void ADC_Input() +{ + uint32_t Dummy; + + //---------------------read data from ADC buffer--------------------------------------------- + Dummy = Dummy; + ExchangeErr &= ~ADC_ERR_MSK; + + if (LPC_SSP0->SR & SSP_BUSY) //åñëè áóôåð ôèôî íå ïîëíûé(ïåðåäà÷à àòèâíà) + { ExchangeErr |= ADC_ERR_MSK; //óñòàíîâèòü ôëàã îøèáêè + + if (!(LPC_SSP0->SR & TX_SSP_EMPT)) //áóôåð ïåðåäà÷è íå ïóñò. + ExchangeErr |= ADC_ERR_MSK; //óñòàíîâèòü ôëàã îøèáêè + } + else //îáìåí çàêîí÷åí ïðî÷èòàòü áóôåð. + { + Input.ArrayIn[0] = LPC_SSP0->DR; //÷òåíèåThermo2 + Input.ArrayIn[1] = LPC_SSP0->DR; //÷òåíèå Thermo1 + Input.ArrayIn[2] = LPC_SSP0->DR; //÷òåíèå HF_out + + while (LPC_SSP0->SR & RX_SSP_notEMPT) //åñëè áóôåð SPI íå ïóñò. + Dummy = LPC_SSP0->DR; //î÷èñòèòü áóôåð. + } + + +} +/***************************************************************************** +** Function name: DAC_Output +** +** Descriptions: Output data to intrnal DAC +** +** parameters: output - code for output +** Returned value: None +** +*****************************************************************************/ +void DAC_Output(int output) +{ +// LPC_DAC->CR = (output<<6); + return; +} +/****************************************************************************** +** Function name: G_Photo_Init +** +** Descriptions: Initialization of exchange with digital potentiometers +** +** parameters: None +** Returned value: None +** +******************************************************************************/ +void G_Photo_Init(void ) +{ + LPC_SC->PCONP |= (1 << 19);//âêëþ÷åíèå èíòåðôåéñà I2C. + + /* set PIO0.27 and PIO0.28 to I2C0 SDA and SCK */ + /* function to 01 on both SDA and SCK. */ + LPC_PINCON->PINSEL1 &= ~0x03C00000; //P0.27 - SDA. + LPC_PINCON->PINSEL1 |= 0x01400000; //P0.28 - SCK. + + // ïîäòâåðæäåíèå Ôëàã ôëàã ðàçðåøåíèÿ + /*ñáðîñ ôëàãîô ôëàãà ïðåðûâàíèÿ I2C ñòàðòà èíòåðôåéñà I2C */ + LPC_I2C0->CONCLR = I2CONCLR_AAC | I2CONCLR_SIC | I2CONCLR_STAC | I2CONCLR_I2ENC; // óñòàíîâêà ìèêðîêîíòðîëëåðà â ðåæèì ìàñòåðà + + /*--- Reset registers ---*/ + LPC_I2C0->SCLL = I2SCLL_SCLL; // - ñ÷åò÷èê scl low time period + LPC_I2C0->SCLH = I2SCLH_SCLH; // - ñ÷åò÷èê scl high time period + + I2CMasterBuffer[0] = A_ADDRESS; //àðåñ ïîòåíöèîìåòðà êàíàëà À + I2CMasterBuffer[1] = WRITE_CMD; //Äàííûå + I2CMasterBuffer[3] = B_ADDRESS; //àðåñ ïîòåíöèîìåòðà êàíàëà  + I2CMasterBuffer[4] = WRITE_CMD; //Äàííûå + + LPC_I2C0->CONSET = I2CONSET_I2EN; //âêëþ÷åíèå èíòåðôåéñà I2C. + +} +/****************************************************************************** +** Function name: DAC_ADC_Exchange_Init +** +** Descriptions: Initialization of data exchange with DACs and ADCs +** +** parameters: None +** Returned value: None +** +******************************************************************************/ +void DAC_ADC_Exchange_Init() +{ + + int Dummy; // èíèöèàëèçàöèÿ ìóñîðêè äëÿ î÷èñòêè áóôåðà ïðèåìà. + Dummy = Dummy; + + /* Enable AHB clock to the SSP0, SSP1 */ + LPC_SC->PCONP |= (0x1<<21); // âêëþ÷åíèå SSP0. +// LPC_SC->PCONP |= (0x1<<10); + + /* âûáîð ÷àñòîòû äëÿ ïåðåôåðèè èñïîëüçóåì ïî óìîë÷àíèÿ ñ äåëèòåëåì îñíîâíîé íà 4 */ + LPC_SC->PCLKSEL1 &= ~(0x3<<10); //00 CLK/4; 1 CLK; 2 CLK/2; 3 CLK/8 + LPC_SC->PCLKSEL1 |= (0x0<<10); //00 CLK/4; 1 CLK; 2 CLK/2; 3 CLK/8 + // LPC_SC->PCLKSEL0 &= ~(0x3<<20); + + // P0.15~0.18 as SSP0 + LPC_PINCON->PINSEL0 &= ~(0x3UL<<30); //óñòàíîâèò Ð 0.15 + LPC_PINCON->PINSEL0 |= (0x2UL<<30); //êàê (???? SCK 0 ???). ÷àñòîòà äëÿ ñèíõðîíèçàöèèè Master - slave + + LPC_PINCON->PINSEL1 &= ~((0x3<<0)|(0x3<<2)|(0x3<<4)); // óñòàíèâîèòü Ð 0.17 è Ð 0.18 + LPC_PINCON->PINSEL1 |= ((0x2<<2)|(0x2<<4)); // êàê MISO0 è MOSI0 + + LPC_PINCON->PINMODE0 &= ~(0x3UL<<30);// ? óñòàíîâëåíèå íà Ð 0.15 ðåæèìà On-Chip pull-down resistor enabled + LPC_PINCON->PINMODE0 |= (0x3UL<<30);// ? óñòàíîâëåíèå íà Ð 0.15 ðåæèìà On-Chip pull-down resistor enabled + + LPC_PINCON->PINMODE1 &= ~((0x3<<2)|(0x3<<4));// ? óñòàíîâëåíèå íà Ð 0.17 è Ð 0.18 ðåæèìà On-Chip pull-down resistor enabled + LPC_PINCON->PINMODE1 |= ((0x3<<2)|(0x3<<4));// ? óñòàíîâëåíèå íà Ð 0.17 è Ð 0.18 ðåæèìà On-Chip pull-down resistor enabled + + /* P0.6~0.9 as SSP1 */ +/* LPC_PINCON->PINSEL0 &= ~((0x3<<12)|(0x3<<14)|(0x3<<16)|(0x3<<18)); + LPC_PINCON->PINSEL0 |= ((0x2<<12)|(0x2<<14)|(0x2<<16)|(0x2<<18)); + LPC_PINCON->PINMODE0 &= ~((0x3<<16)|(0x3<<12)|(0x3<<14)|(0x3<<18)); + LPC_PINCON->PINMODE0 |= ((0x3<<16)|(0x3<<14)|(0x3<<18)); */ + + /* Set DSS data to 16-bit, Frame format TI, SCR is 2 */ + LPC_SSP0->CR0 = ((3<<8)|(0<<7)|(0<<4) |0xF); // (0xF)-óñòàíîâëåíèå DSS(Data sise select) â 16-áèòíûé ôîðìàò, (3<<8 scr - âûáîð ÷àñòîòû), + // íèçêèé óðîâåíü ëèíèè òàêòèðîâàíèÿ ìåæäó êàäðàìè, ïðèêðåïëåíèå ïåðåäà÷è ê ïåðâîìó íàðàñòàíèþ òàêòîâîãî ìèãíàëà + // ôîðìàò êàäðà TI. + // LPC_SSP1->CR0 = 0x0207; + + /* SSPCPSR clock prescale register, master mode, minimum divisor is 0x02 */ + LPC_SSP0->CPSR = 0x2; // freq = CLK/(cpsdvr*(scr+1)) = 1.6 MHz + // LPC_SSP1->CPSR = 0x2; + +/*SSP enable, master mode */ + LPC_SSP0->CR1 = SSPCR1_SSE; +// LPC_SSP1->CR1 = SSPCR1_SSE; + + while (LPC_SSP0->SR & SSP_BUSY); +// while (LPC_SSP1->SR & SSP_BUSY); + + while (LPC_SSP0->SR & RX_SSP_notEMPT) /* clear the RxFIFO */ + Dummy = LPC_SSP0->DR; + //all pins after reset is in GPIO mode, so CS pins needn't to configure + LPC_GPIO0->FIODIR |= ADC; // P0.16 defined as CS for ADC + LPC_GPIO0->FIOSET |= ADC; // set CS for ADC + + LPC_GPIO0->FIODIR |= DAC; // P defined as CS for DAC + LPC_GPIO0->FIOCLR |= DAC; // set CS for DAC +/* while (LPC_SSP1->SR & RX_SSP_notEMPT) + Dummy = LPC_SSP1->DR;*/ /* clear the RxFIFO */ +} +/***************************************************************************** +** Function name: DACInit +** +** Descriptions: initialize DAC channel +** +** parameters: None +** Returned value: None +** +*****************************************************************************/ +void DACInit( void ) +{ + /* setup the related pin to DAC output */ + LPC_PINCON->PINSEL1 |= 0x00200000; /* óñòàíîâèòü p0.26 êàê âûõîä ÖÀÏ */ + // LPC_GPIO0->FIODIR |= (1<<26); + LPC_DAC->CNTVAL = 0; // êêàèåòî ïàðàìåòðû + LPC_DAC->CTRL = 0; // äëÿ ÄÌÀ + return; +} +/****************************************************************************** +** Function name: Out_G_photo +** +** Descriptions: Start of potentiometer data writing process +** +** parameters: pointer to gain factors +** Returned value: None +** +******************************************************************************/ +void Out_G_photo(uint32_t Ph_A, uint32_t Ph_B) +{ + I2CMasterBuffer[2] = Ph_A;// çàïèñü â áóôåð I2C ìàñòåðà äàííûõ ñ À êàíàëà ôîòî äàò÷èêà.(óòî÷íèòü) + I2CMasterBuffer[5] = Ph_B;// çàïèñü â áóôåð I2C ìàñòåðà äàííûõ ñ  êàíàëà ôîòî äàò÷èêà.(óòî÷íèòü) + + LPC_I2C0->CONSET = I2CONSET_STA; // óñòàíîâèòü ñòàðò ôëàã. + I2CMasterState = I2C_BUSY; // óñòàíîâèòü ôëàã çàíÿòîé øèíû. + }