![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
forkd
Fork of LG2 by
Diff: host/Source/App/InputOutput_oldSPI.c
- Revision:
- 23:12e6183f04d4
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/host/Source/App/InputOutput_oldSPI.c Wed Feb 03 10:44:42 2016 +0300 @@ -0,0 +1,429 @@ +#include "InputOutput.h" +#include "lpc17xx.h" + +INPUT Input; +OUTPUT Output; + +volatile uint32_t I2CMasterState = I2C_IDLE; +volatile uint32_t I2CMasterBuffer[I2C_WRITELENGTH]; + +int ExchangeErr = 0; + +/****************************************************************************** +** Function name: G_Photo_Exchange +** +** Descriptions: Driver for I2C exchange +** +** parameters: None +** Returned value: None +** +******************************************************************************/ +#if defined I2C0 +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 + } + else if (WrIndex == 3) + { + LPC_I2C0->CONSET = I2CONSET_STA; + } + else + { + LPC_I2C0->DAT = I2CMasterBuffer[WrIndex++]; //e. send another byte + } + 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; +} +#else +void G_Photo_Exchange(void) +{ + static uint32_t WrIndex; + uint32_t StatValue; + static int 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_TIME_OUT; //e. timer elapsed, go away + LPC_I2C2->CONSET = I2CONSET_STO; //e. Set Stop flag + LPC_I2C2->CONCLR = I2CONCLR_AAC | I2CONCLR_SIC | I2CONCLR_STAC; + return; + } + else if (!(LPC_I2C2->CONSET & I2CONSET_SI)) //e. state of I2C bus has not been changed + return; + + StatValue = LPC_I2C2->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_I2C2->DAT = I2CMasterBuffer[WrIndex++]; //e. send address + LPC_I2C2->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_I2C2->DAT = I2CMasterBuffer[WrIndex++]; //e. send address + LPC_I2C2->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_I2C2->DAT = I2CMasterBuffer[WrIndex++]; //e. send another byte + LPC_I2C2->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; //e. fix new state (release bus) + LPC_I2C2->CONSET = I2CONSET_STO; //e. Set Stop flag + } + else if (WrIndex == 3) + { + LPC_I2C2->CONSET = I2CONSET_STA; + } + else + { + LPC_I2C2->DAT = I2CMasterBuffer[WrIndex++]; //e. send another byte + } + LPC_I2C2->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_I2C2->CONSET = I2CONSET_STO; //e. Set Stop flag + LPC_I2C2->CONCLR = (I2CONCLR_SIC | I2CONCLR_STAC); + I2CMasterState = I2C_IDLE; //e. fix new state (release) + break; + } + return; +} +#endif +/****************************************************************************** +** Function name: DAC_Out_ADC_Input +** +** Descriptions: Loading data to DACs and initialization of ADC reading +** +** parameters: None +** Returned value: None +** +******************************************************************************/ +void DAC_Out_ADC_Input() +{ + int i, Dummy = Dummy; + + //-------------------------loading data from ADC to buffer--------------------------------------- + i = BYTES_FOR_ADCs; + ExchangeErr &= ~ADC_ERR_MSK; //reset ADC bit of error register; + + if (LPC_SSP0->SR & SSP_BUSY) //if exchanging is activing, error + { + ExchangeErr |= ADC_ERR_MSK; //reset DAC bit of error register; + } + else + + while ((i-- > 0) && (LPC_SSP0->SR & TX_SSP_notFULL)) //receiving has finished, initiate a new one + LPC_SSP0->DR = 0xFF; + /* +{ LPC_SSP0->DR = 0x80; + LPC_SSP0->DR = 0x01; + LPC_SSP0->DR = 0xC0; + LPC_SSP0->DR = 0x03; + LPC_SSP0->DR = 0xE0; + LPC_SSP0->DR = 0x07; + LPC_SSP0->DR = 0xF0; + LPC_SSP0->DR = 0x0F; }*/ +// ------------------------loading data to DACs-------------------------------------------------- + ExchangeErr &= ~DAC_ERR_MSK; //reset DAC bit of error register; + i= BYTEs_FOR_DACs >> 1; + if (LPC_SSP1->SR & SSP_BUSY) //if exchanging is activing, error + { + ExchangeErr |= DAC_ERR_MSK; + } + else + while ((i-->0) && (LPC_SSP1->SR & TX_SSP_notFULL)) //load new data to DAC + { + LPC_SSP1->DR = (Output.ArrayOut[i]>>8)& 0xFF; + if (LPC_SSP1->SR & TX_SSP_notFULL) + LPC_SSP1->DR = Output.ArrayOut[i] & 0xFF; + } + +/* { LPC_SSP1->DR = 0x80; + LPC_SSP1->DR = 0x01; + LPC_SSP1->DR = 0xC0; + LPC_SSP1->DR = 0x03; + LPC_SSP1->DR = 0xE0; + LPC_SSP1->DR = 0x07; + LPC_SSP1->DR = 0xF0; + LPC_SSP1->DR = 0x0F; } */ + + if (i != 0xFFFFFFFF) + { + ExchangeErr |= DAC_ERR_MSK; + } +} +/****************************************************************************** +** Function name: ADC_Out_DAC_Input +** +** Descriptions: Reading data from ADC and initialization of DAC writing +** +** parameters: None +** Returned value: None +** +******************************************************************************/ +void ADC_Out_DAC_Input() +{ + int i = 0, Dummy; + static int timeDither = 0; + Dummy = Dummy; + + //++++++++++++++++++++++++++ Dither_simulation ++++++++++++++++++++++++++++++++++++++++++++++++ + + if (++timeDither>(LPC_MCPWM->LIM0/50)) + { + LPC_MCPWM->INTF_SET |= 1; + timeDither = 0; + } + //----------------------read receiver buffer of DAC-------------------------------------------- + ExchangeErr &= ~DAC_ERR_MSK; + + if (LPC_SSP1->SR & SSP_BUSY) //if exchanging is active, error + { + ExchangeErr |= DAC_ERR_MSK; + } + else //exchanging has finished, read buffer + { + while (LPC_SSP1->SR & RX_SSP_notEMPT) + { + Dummy = LPC_SSP1->DR; + i++; + } + + if (i != BYTEs_FOR_DACs) + { + ExchangeErr |= DAC_ERR_MSK; + } + } + + //---------------------read data from ADC buffer--------------------------------------------- + i = BYTES_FOR_ADCs >> 1; + ExchangeErr &= ~ADC_ERR_MSK; + + if (LPC_SSP0->SR & SSP_BUSY) //if exchanging is active, error + { + if ((LPC_SSP0->SR & TX_SSP_EMPT)==0) + ExchangeErr |= ADC_ERR_MSK; + } + else //exchanging has finished, read buffer + { + while ((i-- > 0)&& (LPC_SSP0->SR & RX_SSP_notEMPT) ) //read buffer while data present + { + Input.ArrayIn[i] = ((LPC_SSP0->DR & 0xFF) << 8); + if (LPC_SSP0->SR & RX_SSP_notEMPT) + Input.ArrayIn[i] |= (LPC_SSP0->DR & 0xFF); + else + break; + } + if (i != 0xFFFFFFFF) + ExchangeErr |= ADC_ERR_MSK; + } +} +/****************************************************************************** +** Function name: G_Photo_Init +** +** Descriptions: Initialization of exchange with digital potentiometers +** +** parameters: None +** Returned value: None +** +******************************************************************************/ +#if !defined I2C0 +void G_Photo_Init( void ) +{ + LPC_SC->PCONP |= (1 << 26); //e. enable I2C interface + //e. by default sync frequency is CCLK/4 (see PCLKSEL1[21:20]) + + //e. set P0.10 and P0.11 to I2C2 SDA and SCL + LPC_PINCON->PINSEL0 &= ~((0x03<<20)|(0x03<<22)); //e. clear + LPC_PINCON->PINSEL0 |= ((0x02<<20)|(0x02<<22)); //e. set SDA2, SCL2 + LPC_PINCON->PINMODE0 &= ~((0x03<<20)|(0x03<<22)); //e. clear + LPC_PINCON->PINMODE0 |= ((0x02<<20)|(0x2<<22)); //e. No pull-up no pull-down + LPC_PINCON->PINMODE_OD0 |= ((0x01<<10)|(0x1<<11));//e. switch SDA2, SCL2 to open drain mode + + //--- Clear flags --- + LPC_I2C2->CONCLR = I2CONCLR_AAC | I2CONCLR_SIC | I2CONCLR_STAC | I2CONCLR_I2ENC; + + //--- Set registers for transmition rate = PCLK/(I2SCLL_SCLL+I2SCLH_SCLH)--- + LPC_I2C2->SCLL = I2SCLL_SCLL; + LPC_I2C2->SCLH = I2SCLH_SCLH; + + I2CMasterBuffer[0] = A_ADDRESS; + I2CMasterBuffer[1] = WRITE_CMD; + I2CMasterBuffer[3] = B_ADDRESS; + I2CMasterBuffer[4] = WRITE_CMD; + + LPC_I2C2->CONSET = I2CONSET_I2EN; + return; +} +#else +void G_Photo_Init(void ) +{ + LPC_SC->PCONP |= (1 << 19); + + /* set PIO0.27 and PIO0.28 to I2C0 SDA and SCK */ + /* function to 01 on both SDA and SCK. */ + LPC_PINCON->PINSEL1 &= ~0x03C00000; + LPC_PINCON->PINSEL1 |= 0x01400000; + + /*--- Clear flags ---*/ + LPC_I2C0->CONCLR = I2CONCLR_AAC | I2CONCLR_SIC | I2CONCLR_STAC | I2CONCLR_I2ENC; + + /*--- Reset registers ---*/ + LPC_I2C0->SCLL = I2SCLL_SCLL; + LPC_I2C0->SCLH = I2SCLH_SCLH; + + I2CMasterBuffer[0] = A_ADDRESS; + I2CMasterBuffer[1] = WRITE_CMD; + I2CMasterBuffer[3] = B_ADDRESS; + I2CMasterBuffer[4] = WRITE_CMD; + + LPC_I2C0->CONSET = I2CONSET_I2EN; + +} +#endif +/****************************************************************************** +** 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); + // LPC_SC->PCONP |= (0x1<<10); + + /* Further divider is needed on SSP0,SSP1 clock. Using default divided by 4 */ + LPC_SC->PCLKSEL1 &= ~(0x3<<10); + LPC_SC->PCLKSEL0 &= ~(0x3<<20); + + /* P0.15~0.18 as SSP0 */ + LPC_PINCON->PINSEL0 &= ~(0x3UL<<30); + LPC_PINCON->PINSEL0 |= (0x2UL<<30); + LPC_PINCON->PINSEL1 &= ~((0x3<<0)|(0x3<<2)|(0x3<<4)); + LPC_PINCON->PINSEL1 |= ((0x2<<0)|(0x2<<2)|(0x2<<4)); + + LPC_PINCON->PINMODE0 &= ~(0x3UL<<30); + LPC_PINCON->PINMODE0 |= (0x3UL<<30); + LPC_PINCON->PINMODE1 &= ~((0x3<<2)|(0x3<<4)); + LPC_PINCON->PINMODE1 |= ((0x3<<2)|(0x3<<4)); + + /* 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 8-bit, Frame format SPI, CPOL = 0, CPHA = 0, and SCR is 2*/ + LPC_SSP0->CR0 = 0x0207; + LPC_SSP1->CR0 = 0x0207; + + /* SSPCPSR clock prescale register, master mode, minimum divisor is 0x02 */ + LPC_SSP0->CPSR = 0x2; + LPC_SSP1->CPSR = 0x2; //so, SSPfreq = PCLK/(2*(2+1)) = 4.13 MHz + + 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; + + while (LPC_SSP1->SR & RX_SSP_notEMPT) + Dummy = LPC_SSP1->DR; /* clear the RxFIFO */ +} +/****************************************************************************** +** 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; + I2CMasterBuffer[5] = Ph_B; +#if defined I2C0 + LPC_I2C0->CONSET = I2CONSET_STA; // Set Start flag +#else + LPC_I2C2->CONSET = I2CONSET_STA; // Set Start flag +#endif + I2CMasterState = I2C_BUSY; + }