void TFC_InitADCs()
{
InitADC1();
//All Adc processing of the Pots and linescan will be done in the ADC1 IRQ!
//A state machine will scan through the channels.
//This is done to automate the linescan capture on Channel 1 to ensure that timing is very even
CurrentADC_State = ADC_STATE_INIT;
//The pump will be primed with the PIT interrupt. upon timeout/interrupt it will se the SI signal high
//for the camera and then start the conversions for the pots.
//Enable clock to the PIT
SIM_SCGC6 |= SIM_SCGC6_PIT_MASK;
//We will use PIT0
TFC_SetLineScanExposureTime(TFC_DEFAULT_LINESCAN_EXPOSURE_TIME_uS);
//enable PIT0 and its interrupt
PIT_TCTRL0 = PIT_TCTRL_TEN_MASK | PIT_TCTRL_TIE_MASK;
PIT_MCR |= PIT_MCR_FRZ_MASK; // stop the pit when in debug mode
//Enable the PIT module
PIT_MCR &= ~PIT_MCR_MDIS_MASK;
enable_irq(INT_PIT0-16);
enable_irq(INT_ADC1-16);
#ifdef TFC_USE_NTSC_CAMERA
InitADC0();
#endif
}
///////////////////////////////////////////////////////////////////////////////////////////////
//////////////////////////////////////// MAIN FUNCTION ////////////////////////////////////////
///////////////////////////////////////////////////////////////////////////////////////////////
int main(void)
{
///////////////////////////////////////////////////////////////////////////////////////////
//////////////////////////////////////// SETUP ////////////////////////////////////////////
///////////////////////////////////////////////////////////////////////////////////////////
// Analog/Digital Pin Configuration
ANSELA = 0x0000;
ANSELB = 0x0000;
ANSELC = 0x0000;
ANSELD = 0x0000;
ANSELG = 0x0000;
ANSELCbits.ANSC1 = 0; // Pin 22 (RC1/AN7) is analog (Trigger)
ANSELAbits.ANSA0 = 1; // Pin 13 (RA0/AN0) is analog (ADC1CH0)
ANSELAbits.ANSA1 = 1; // Pin 14 (RA1/AN1) is analog (ADC1CH1)
ANSELBbits.ANSB0 = 1; // Pin 15 (RB0/AN2) is analog (ADC1CH2)
ANSELBbits.ANSB1 = 1; // Pin 16 (RB1/AN3) is analog (ADC1CH3)
__builtin_write_OSCCONL(OSCCON & 0xBF); // unlock registers to configure PPS
RPOR7bits.RP57R = 0b10000; // configure RP57 as OC1 (PWM Horizontal)
__builtin_write_OSCCONL(OSCCON | 0x40); // lock registers
// Digital I/O Pin Configuration
//TRISCbits.TRISC9 = 0;
TRISEbits.TRISE14 = 0; // Pin 29 (RE14) is a digital output (Chip Select 1)
SPI_CS1_HIGH;
TRISEbits.TRISE15 = 0; // Pin 30 (RE15) is a digital output (Chip Select 2)
SPI_CS2_HIGH;
TRISBbits.TRISB4 = 0; // Pin 32 (RB4) is a digital output (SPI Clock)
SPI_CLK_LOW;
TRISAbits.TRISA8 = 0; // Pin 31 (RA8) is a digital output (SPI Data In)
SPI_DIN_LOW;
TRISGbits.TRISG6 = 0; // Register Select Output for LCD.
// Initializing Main Loop
InitSystemClock133(); // Make sure this matches in the config.h (FOSC 133333332LL)
//InitSystemClock140(); // Make sure this matches in the config.h (FOSC 140000000LL)
_NSTDIS = 0;
GenPurpTimer32();
InitNoTriggerWatchdogTimer();
InitC4TriggerTimer();
InitTrigger();
CaptureFrontTimer();
InitPWM();
initPMP();
initLCD();
InitADC1();
clearLCD();
WritePGA(PGA_gain); // Initializes both PGAs
//homeScreen();
WriteServo(90,90); // Initialize servo positions (whole number degrees from 0 to 180))
while(1)
{
// Infinite Loop:
WriteServo(90,90);
delay_ms(1000);
WriteServo(90+35,90);
delay_ms(1000);
WriteServo(90,90);
delay_ms(1000);
WriteServo(90-35,90);
delay_ms(1000);
}
}
/**
* @brief Main program.
* @param None
* @retval None
*/
int main(void)
{
char test[25];
unsigned int an1, an2, an3, an4, an5;
float Ta=0;
int i;
long msum[4];
float fm[4], T1, T2, T3, SP;
unsigned int DSState = 0;
unsigned long DSTimer=0, t0, t1, dt, HTimer, TTimer, t_sec, t_min;
unsigned char data[2];
unsigned char out=0;
unsigned int decval;
volatile float pp, pi, pd, f_error, error_old=0, pid_out, pid_out_i, pid_out_p, pid_out_d, error_i=0;
u8 Send_Buffer[25];
u8 tmp[4];
//char no_windup = 0;
RCC_Configuration();
NVIC_Configuration();
/* SysTick end of count event each 1ms with input clock equal to 9MHz (HCLK/8, default) */
SysTick_SetReload(9000);
/* Enable SysTick interrupt */
SysTick_ITConfig(ENABLE);
/* Enable the SysTick Counter */
SysTick_CounterCmd(SysTick_Counter_Enable);
GPIO_Setup();
RCC_APB1PeriphClockCmd(RCC_APB1Periph_SPI2, ENABLE);
/* SPI2 Config -------------------------------------------------------------*/
SPI_InitStructure.SPI_Direction = SPI_Direction_2Lines_FullDuplex;
SPI_InitStructure.SPI_Mode = SPI_Mode_Master;
SPI_InitStructure.SPI_DataSize = SPI_DataSize_8b;
SPI_InitStructure.SPI_CPOL = SPI_CPOL_Low;
SPI_InitStructure.SPI_CPHA = SPI_CPHA_2Edge;
SPI_InitStructure.SPI_NSS = SPI_NSS_Soft;
SPI_InitStructure.SPI_BaudRatePrescaler = SPI_BaudRatePrescaler_256;
SPI_InitStructure.SPI_FirstBit = SPI_FirstBit_MSB;
SPI_InitStructure.SPI_CRCPolynomial = 7;
SPI_Init(SPI2, &SPI_InitStructure);
/* Enable SPI1 */
SPI_CalculateCRC(SPI2, DISABLE);
SPI_Cmd(SPI2, ENABLE);
InitADC1(); // ADC1 Init
OWInit(&OneWire, GPIOB, GPIO_Pin_8);
/* Connect Key Button EXTI Line to Key Button GPIO Pin */
//GPIO_EXTILineConfig(GPIO_PortSourceGPIOA, GPIO_Pin_7);
/* Configure Key Button EXTI Line to generate an interrupt on falling edge */
//EXTI_InitStructure.EXTI_Line = EXTI_Line7;
//EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt;
//EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Falling;
//EXTI_InitStructure.EXTI_LineCmd = ENABLE;
//EXTI_Init(&EXTI_InitStructure);
/* Time base configuration */
TIM_TimeBaseStructure.TIM_Period = 55000;
TIM_TimeBaseStructure.TIM_Prescaler = 12;
TIM_TimeBaseStructure.TIM_ClockDivision = 0;
TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure);
/* TIM2 PWM2 Mode configuration: Channel1 */
TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2;
TIM_OCInitStructure.TIM_Channel = TIM_Channel_1;
TIM_OCInitStructure.TIM_Pulse = 1;//20000;
TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;
TIM_OCInit(TIM3, &TIM_OCInitStructure);
/* TIM2 configuration in Input Capture Mode */
TIM_ICStructInit(&TIM_ICInitStructure);
TIM_ICInitStructure.TIM_Channel = TIM_Channel_2;
TIM_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Falling;
TIM_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI;
TIM_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1;
TIM_ICInitStructure.TIM_ICFilter = 0;
TIM_ICInit(TIM3, &TIM_ICInitStructure);
/* One Pulse Mode selection */
TIM_SelectOnePulseMode(TIM3, TIM_OPMode_Single);
/* Input Trigger selection */
TIM_SelectInputTrigger(TIM3, TIM_TS_TI2FP2);
/* Slave Mode selection: Trigger Mode */
TIM_SelectSlaveMode(TIM3, TIM_SlaveMode_Trigger);
ST7565_st7565_init();
ST7565_st7565_command(CMD_SET_BIAS_9);
ST7565_st7565_command(CMD_DISPLAY_ON);
ST7565_st7565_command(CMD_SET_ALLPTS_NORMAL);
ST7565_st7565_set_brightness(0x0C);
OWSearch(&OneWire, addr);
/*sprintf(test, "%02X %02X %02X %02X %02X %02X %02X %02X",
addr[7],addr[6],
addr[5],addr[4],
addr[3],addr[2],
addr[1],addr[0]);
ST7565_drawstring(6, 6, test);
*/
USB_Init();
ST7565_display(); // show splashscreen
t0 = millis();
HTimer = millis();
TTimer = millis();
pp = 10;
pi = 0;
pd = 150;
while(1)
{
msum[0] = 0;
msum[1] = 0;
msum[2] = 0;
msum[3] = 0;
for (i = 0; i < 1000; i++) {
an1 = GetADC1Channel(ADC_Channel_1);
an2 = GetADC1Channel(ADC_Channel_2);
an3 = GetADC1Channel(ADC_Channel_3);
an4 = GetADC1Channel(ADC_Channel_4);
an5 = GetADC1Channel(ADC_Channel_5);
msum[0] += an1;
msum[1] += an3 - an2;
msum[2] += an4 - an2;
msum[3] += an5 - an2;
//DelayuS(333);
}
SP = round((msum[0] / 1000.0) * (60.0 / 4096)) * 5;
fm[1] = (msum[1] / 1000.0);
fm[2] = (msum[2] / 1000.0) + 12;
fm[3] = (msum[3] / 1000.0) - 7;
T1 = (T1 + Ta + Dac2Dt(fm[1])) / 2;
T2 = (T2 + Ta + Dac2Dt(fm[2])) / 2;
T3 = (T3 + Ta + Dac2Dt(fm[3])) / 2;
t1 = millis();
dt = t1 - t0;
t0 = t1;
if (millis() - HTimer > 1000) {
f_error = SP - T2;
//if (noerror_i += error;
pid_out_p = pp * f_error;
pid_out_i = pi * error_i;
pid_out_d = pd * (f_error - error_old);
pid_out = pid_out_p + pid_out_i + pid_out_d;
error_old = f_error;
//out = pid_out;
if (pid_out > 99) {
out = 99;
} else if (pid_out < 0) {
out = 0;
} else {
out = round(pid_out);
}
TIM_SetCompare1(TIM3, 55000-PowerValues[out]);
HTimer += 1000;
//error_old = 10;
sprintf(test, "T1 : %5.1f E %5.1f ", T1, f_error);
ST7565_drawstring(6, 0, test);
sprintf(test, "T2 : %5.1f ", T2);
ST7565_drawstring(6, 1, test);
sprintf(test, "T3 : %5.1f ", T3);
ST7565_drawstring(6, 2, test);
sprintf(test, "SP : %5.1f P %6.1f ", SP, pid_out_p);
ST7565_drawstring(6, 3, test);
sprintf(test, "Ta : %5.1f I %6.1f ", Ta, pid_out_i);
ST7565_drawstring(6, 4, test);
sprintf(test, "dt : %5lu D %6.1f ", dt, pid_out_d);
ST7565_drawstring(6, 5, test);
sprintf(test, "out: %3u %% %6.1f ", out, pid_out);
ST7565_drawstring(6, 6, test);
t_sec = (millis() - TTimer) / 1000;
t_min = floor(t_sec / 60);
t_sec %= 60;
Send_Buffer[0] = 0x07;
decval = round(T1 * 100);
memcpy(&Send_Buffer[1], &decval, 2);
decval = round(T2 * 100);
memcpy(&Send_Buffer[3], &decval, 2);
decval = round(T3 * 100);
memcpy(&Send_Buffer[5], &decval, 2);
decval = round(SP * 100);
memcpy(&Send_Buffer[7], &decval, 2);
memcpy(&Send_Buffer[9], &out, 1);
//sprintf(test, "%02X %02X %02X %02X ", Send_Buffer[1], Send_Buffer[2], Send_Buffer[3], Send_Buffer[4]);
//ST7565_drawstring(6, 7, test);
UserToPMABufferCopy(Send_Buffer, ENDP1_TXADDR, 9);
SetEPTxCount(ENDP1, 9);
SetEPTxValid(ENDP1);
ST7565_display();
}
if (GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_0) == 0) {
TTimer = millis();
}
//onewire
switch (DSState){
case 0:
OWReset(&OneWire);
OWWrite(&OneWire, 0xCC); // skip ROM
OWWrite(&OneWire, 0x44); // start conversion
DSTimer = millis();
DSState++;
break;
case 1:
if((millis() - DSTimer) >= 1000){
OWReset(&OneWire);
OWSelect(&OneWire, addr);
OWWrite(&OneWire, 0xBE); // Read Scratchpad
data[0] = OWRead(&OneWire);
data[1] = OWRead(&OneWire);
Ta = ((data[1] << 8) | data[0]) / 16.0;
DSState = 0;
}
break;
}
}
}
