Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <xc.h>
- #include <htc.h>
- #define _XTAL_FREQ 5000000
- // PIC18F2550 Configuration Bit Settings
- // CONFIG1L
- #pragma config PLLDIV = 1 // PLL Prescaler Selection bits (No prescale (4 MHz oscillator input drives PLL directly))
- #pragma config CPUDIV = OSC1_PLL2// System Clock Postscaler Selection bits ([Primary Oscillator Src: /1][96 MHz PLL Src: /2])
- #pragma config USBDIV = 1 // USB Clock Selection bit (used in Full-Speed USB mode only; UCFG:FSEN = 1) (USB clock source comes directly from the primary oscillator block with no postscale)
- // CONFIG1H
- #pragma config FOSC = HS
- #pragma config FCMEN = OFF // Fail-Safe Clock Monitor Enable bit (Fail-Safe Clock Monitor disabled)
- #pragma config IESO = OFF // Internal/External Oscillator Switchover bit (Oscillator Switchover mode disabled)
- // CONFIG2L
- #pragma config PWRT = OFF // Power-up Timer Enable bit (PWRT disabled)
- #pragma config BOR = OFF // Brown-out Reset Enable bits (Brown-out Reset enabled in hardware only (SBOREN is disabled))
- #pragma config BORV = 3 // Brown-out Reset Voltage bits (Minimum setting 2.05V)
- #pragma config VREGEN = OFF // USB Voltage Regulator Enable bit (USB voltage regulator disabled)
- // CONFIG2H
- #pragma config WDT = ON // Watchdog Timer Enable bit (WDT disabled (control is placed on the SWDTEN bit))
- #pragma config WDTPS = 32768 // Watchdog Timer Postscale Select bits (1:32768)
- // CONFIG3H
- #pragma config CCP2MX = OFF // CCP2 MUX bit (CCP2 input/output is multiplexed with RC1)
- #pragma config PBADEN = OFF // PORTB A/D Enable bit (PORTB<4:0> pins are configured as analog input channels on Reset)
- #pragma config LPT1OSC = OFF // Low-Power Timer 1 Oscillator Enable bit (Timer1 configured for higher power operation)
- #pragma config MCLRE = OFF // MCLR Pin Enable bit (MCLR pin enabled; RE3 input pin disabled)
- // CONFIG4L
- #pragma config STVREN = OFF // Stack Full/Underflow Reset Enable bit (Stack full/underflow will cause Reset)
- #pragma config LVP = OFF // Single-Supply ICSP Enable bit (Single-Supply ICSP enabled)
- #pragma config XINST = OFF // Extended Instruction Set Enable bit (Instruction set extension and Indexed Addressing mode disabled (Legacy mode))
- // CONFIG5L
- #pragma config CP0 = OFF // Code Protection bit (Block 0 (000800-001FFFh) is not code-protected)
- #pragma config CP1 = OFF // Code Protection bit (Block 1 (002000-003FFFh) is not code-protected)
- #pragma config CP2 = OFF // Code Protection bit (Block 2 (004000-005FFFh) is not code-protected)
- #pragma config CP3 = OFF // Code Protection bit (Block 3 (006000-007FFFh) is not code-protected)
- // CONFIG5H
- #pragma config CPB = OFF // Boot Block Code Protection bit (Boot block (000000-0007FFh) is not code-protected)
- #pragma config CPD = OFF // Data EEPROM Code Protection bit (Data EEPROM is not code-protected)
- // CONFIG6L
- #pragma config WRT0 = OFF // Write Protection bit (Block 0 (000800-001FFFh) is not write-protected)
- #pragma config WRT1 = OFF // Write Protection bit (Block 1 (002000-003FFFh) is not write-protected)
- #pragma config WRT2 = OFF // Write Protection bit (Block 2 (004000-005FFFh) is not write-protected)
- #pragma config WRT3 = OFF // Write Protection bit (Block 3 (006000-007FFFh) is not write-protected)
- // CONFIG6H
- #pragma config WRTC = OFF // Configuration Register Write Protection bit (Configuration registers (300000-3000FFh) are not write-protected)
- #pragma config WRTB = OFF // Boot Block Write Protection bit (Boot block (000000-0007FFh) is not write-protected)
- #pragma config WRTD = OFF // Data EEPROM Write Protection bit (Data EEPROM is not write-protected)
- // CONFIG7L
- #pragma config EBTR0 = OFF // Table Read Protection bit (Block 0 (000800-001FFFh) is not protected from table reads executed in other blocks)
- #pragma config EBTR1 = OFF // Table Read Protection bit (Block 1 (002000-003FFFh) is not protected from table reads executed in other blocks)
- #pragma config EBTR2 = OFF // Table Read Protection bit (Block 2 (004000-005FFFh) is not protected from table reads executed in other blocks)
- #pragma config EBTR3 = OFF // Table Read Protection bit (Block 3 (006000-007FFFh) is not protected from table reads executed in other blocks)
- // CONFIG7H
- #pragma config EBTRB = OFF // Boot Block Table Read Protection bit (Boot block (000000-0007FFh) is not prote
- int SaveU=1; //Настоящий уровень стабилизации
- unsigned int SU[5][4]={0,0,0,0,1,0,0,0,1,1,0,0,1,1,1,0,1,1,1,1};
- unsigned int SUU[5]={1,2,3,4,5};
- unsigned int FlagA=0;
- unsigned int FlagB=0;
- unsigned int FlagC=0;
- unsigned int FlagT=0;
- unsigned int FlagDA=0;
- unsigned int FlagDB=0;
- unsigned int FlagDC=0;
- unsigned char TA=0;
- unsigned char TB=0;
- unsigned char TC=0;
- float ADCU=0; //?????????? ?? ???
- float TrueU=.0f; //???????????????? ?????????? ????? ???
- int i=0, j=0; //Изначально уровень 0\0
- void Button(void);
- void ADC (void);
- void Comparison(void);
- void FuncSUj(void);
- void FuncA (void);
- void FuncB (void);
- void FuncC (void);
- void main(void) {
- //Настройка портов
- TRISB=0xFF; //Весь В на вход
- PORTB=0x00; //Очистка B
- TRISC=0x00; //Весь С на выход
- PORTC=0x00;
- ADCON1=0x0E; //AN0 - аналоговый пин
- //Остальные А - цифровые пины
- TRISA=0x01; //AN0 вход, остальные выход
- PORTA=0x00; //Сброс А
- //Настройка АЦП
- ADCON2=0x9A; //Fosc\32
- //2Tad
- //Tad=1,6???
- ADCON0=0x01; //Канал АЦП - AN0
- //Модуль АЦП Вкл
- //Настройка таймера
- T08BIT = 0; // Timer0 - 16бит
- T0CS = 0; // TMR0 тактирование от внутреннего генератора
- T0SE = 0; // TMR0 инкрементирование от меньшего к большему
- PSA = 0; // Предделитель вкл
- T0PS2 = 1; // Предделитель 1\256
- T0PS1 = 1;
- T0PS0 = 1;
- TMR0ON=0; //TMR0 стоп
- //Настройка прерываний
- RBIE=1; //Прерывание от RB4-7 (кнопка) Вкл
- RBIF=0; //Флаг RB4-7 снят
- GIE=1; //Разрешение глобальных прерываний
- LATA1=1;
- LATA2=0;
- LATA3=0;
- //Основное тело программы
- while(1){
- ADC(); //Функция АЦП
- Comparison(); //Функция сравнения
- // FuncSUj(); //Функция передачи СУ
- }
- }
- void __interrupt () PBInt (void){ //Функция обработки прерываний
- if (RBIE && RBIF){ //Проверка на прерывание RB4-7 (Кнопка)
- PORTB=PORTB; //Инициализация ПортВ
- RBIF=0; //Флаг RBIE снят
- RBIE=0; //RBIE Откл
- Button(); //Функция обработки кнопки
- }
- if (INT0IE && INT0IF){ //Прерывание детектора фазы А
- INT0IF=0;
- FuncA();
- }
- if (INT1IE && INT1IF){ //Прерывание детектора фазы В
- INT1IF=0;
- FuncB();
- }
- if (INT2IE && INT2IF){ //Прерывание детектора фазы С
- INT2IF=0;
- FuncC();
- }
- }
- void Button (void){ //Функция кнопки
- if (LATB4){ //Нажата ли кнопка?
- __delay_ms(300); //Ждём 300мс
- if (LATB4){ //Нажата ли всё ещё?
- if (SaveU==3) SaveU=1; //Если стоит уровень 3, меняем на 1й
- else SaveU=SaveU+1; //Иначе увеличиваем уровень на 1
- }
- }
- switch (SaveU){ //Обработка индикаторов уровня
- case 1: //В случае если уровень 1
- LATA=0x00; //Обнуляем порт
- LATA1=1; //Зажигаем первую лампочку
- break; //Выход из Switch
- case 2: //Аналогично
- LATA=0x00;
- LATA2=1;
- break;
- case 3:
- LATA=0x00;
- LATA3=1;
- break;
- }
- __delay_ms(300); //Ещё одно ожидание?
- RBIE=1; //Разрешаем прерывание от кнопки
- }
- void ADC (void){ //Функция АЦП
- __delay_ms(5); //Маленькая пауза
- GO=1; //АЦП запуск обработки
- while(GO); //Ждём завершения обработки
- ADCU=(ADRESH << 8)+ADRESL; //Занесение младшего и старшего бита АЦП в один регистр
- TrueU=(ADCU*5)/1024; //Высчитываем измеренное значение
- __delay_ms(10); //Маленькая пауза
- }
- void FuncSUj (void){
- INT0IE=1; //Прерывание детектора А
- INT1IE=1; //Прерывание детектора В
- INT2IE=1; //Прерывание детектора С
- for (j=0;j<=3;j++){
- do{
- if (FlagA && FlagB && FlagC){
- FlagT=1;
- }
- }while (!FlagT);
- FlagT=0;
- FlagA=0;
- FlagB=0;
- FlagC=0;
- }
- }
- void FuncA (void){
- switch(TA){
- case 0:
- if (SU[i][j]==0){
- LATA5=1;
- LATA4=0;
- }
- else{
- LATA5=0;
- LATA4=1;
- }
- TA++;
- break;
- case 1:
- TA=0;
- FlagA=1;
- break;
- }
- }
- void FuncB (void){
- switch(TB){
- case 0:
- if (SU[i][j]==0){
- LATC1=1;
- LATC0=0;
- }
- else{
- LATC1=0;
- LATC0=1;
- }
- TB++;
- break;
- case 1:
- TB=0;
- FlagB=1;
- break;
- }
- }
- void FuncC (void){
- switch(TC){
- case 0:
- if (SU[i][j]==0){
- LATC7=1;
- LATC6=0;
- }
- else{
- LATC7=0;
- LATC6=1;
- }
- TC++;
- break;
- case 1:
- TC=0;
- FlagC=1;
- break;
- }
- }
- void Comparison (void){ //Функция сравнения
- if (TrueU>=SaveU){
- TMR0H = 0x1B; //3 сек таймер
- TMR0L = 0x1E;
- TMR0ON=1; //Включаем таймер
- do{
- ADC();
- if (TrueU>=SaveU){
- FuncSUj();
- }
- else{
- TMR0ON=0; //Остановка таймера
- return; //Выход из функции сравнения
- }
- }while(!TMR0IF);
- TMR0IF=0;
- do{ //Делаем цикл, пока не поднимется флаг TMR0 (3сек)
- if (SUU[i]>=2){
- i--; //Понижение уровня СУ
- TMR0H = 0x1B; //3 сек таймер
- TMR0L = 0x1E;
- TMR0ON=1; //Включаем таймер
- do{
- FuncSUj();
- }while(!TMR0IF); //Делаем в течение 3х сек
- }
- else return;
- ADC();
- }while(TrueU>=SUU[i]);
- i++;
- FuncSUj();
- return;
- }
- else{
- if (abs(SUU[i]-SaveU)<=2){
- i++;
- FuncSUj();
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement