Arduino 3 phase inverter

 //Auto Rerun 3 sinus motor controller Arduino mini 168 Arduino 328 P 

#define UN (400.0) //napiecie znamionowe silnika

#define FN (50.0) //czestotliwosc znamionowa silnika

#define P (UN/FN) //wsp. okreslajacy proporcje napiecia do czestotliwoci znamionowej

#define T_PWM (0.000255) //okres sygnalu PWM - ustawiony przez preskaler w licznikach

#define T_MAX (4.0) //okreslenie maksymalnego okresu napiecia wyjsciowego

#define T_MIN (0.02) //minimalny okres napiecia wyjsciowego

#define K_MAX floor(T_MAX/T_PWM) //liczba wartosci okresu dla T_MAX

#define K_MIN ceil(T_MIN/T_PWM) //liczba wartosci okresu dla T_MIN


volatile static unsigned int dlugosc_tab_sin; //zmienna zawierajaca liczbe wartosci w pelnym

//okresie napiecia wyjsciowego

static unsigned int i = 0; //zmienna pomocniacza

volatile static unsigned int licznik_glowny = 0;//zmienna wystepujaca w przerwaniu czyklicznie

//^ co okres T_PWM zwiekszajaca swoja wartosc o 1

static unsigned int next_value_sin = 0; //zmienna ktora wartosc sin nalezy obliczyc

static double t_param=100; //parametr okreslajacy okres napiecia wyjsciowego

static float t = T_PWM; //T_PWM

static float omega_t; //pulsacja napiecia wyjsciowego pomnozona przez T_PWM

static float t_out; //okres wyjsciowy napiecia

static float U_o_param; //parametr okreslajacy wielkosc napiecie wyjsciowego

//^ obliczony na podstawie t_out i U_in

static unsigned int ocr0a, ocr0b, ocr1a;//zmienne pomocnicze do przechowywania obl. wypelnien

static unsigned int ocr1b, ocr2a, ocr2b;//^

static double sin_in; //zmienna zawierajaca parametr funkcji sin

static double blad = 1; //zmienna uzyta do zatrzymania generowania napiecia przy przeciazeniu 

static unsigned int analog=0; //zmienna zawierajaca zmierzona wartosc

static double U_in = 0; //zmienna przechowuj¹ca pomiar napiecia ukladu posredniczacego

static double U_rms_max; //maksymalna aktualnie mozliwa do generacji wartosc skuteczna napiecia

static bool a=0; //zmienna logiczna do realizacji dwoch naprzemiennych pomiarow 

int main() 

{

io_init(); //inicjalizacja wejsc i wyjsc

timers_init(); //inicjalizacja licznikow PWM 

adc_init(); //inicjalizacja przetwornika ADC

while(1) //nieskonczona petla z programem glownym

{

if(i==185) //warunek okreslajacy wejscie do funkcji zmiany 

{ //parametrow napiecia wysjciowego, wywolanie co okolo 100ms

zmien_predkosc(); //funkcja zmiany parametrow napiecia wyjsciowego

i=0;

}

next_value_sin = licznik_glowny%dlugosc_tab_sin; //kolejna warto?æ sinusa do obliczenia

sin_in=omega_t*next_value_sin;


/*obliczenie wartosci do rejestrow okreslajacych wypelnienie sygnalu wyjscioweg*/

ocr0a = round(blad*(U_o_param*(sin(sin_in)+1)*254/2)+1);//pin 6

ocr0b = ocr0a - 1;

ocr1a = round(blad*(U_o_param*(sin(sin_in-2.09)+1)*254/2)+1);//pin 9

ocr1b = ocr1a - 1;

ocr2a = round(blad*(U_o_param*(sin(sin_in+2.09)+1)*254/2)+1);//pin 11

ocr2b = ocr2a - 1;


/*uaktualnienie wartosci w rejestrach*/

cli(); //zabronienie na obsloge przerwan na wypadek gdyby 

//podczas uaktualniania wystapilo przerwanie

OCR0A = ocr0a; //pin 6

OCR0B = ocr0b; //pin 5

OCR1AL = ocr1a; //pin 9

OCR1BL = ocr1b; //pin 10

OCR2A = ocr2a; //pin 11

OCR2B = ocr2b; //pin 3

sei(); //zezwolenie na obsloge przerwan

i++;

}

}

void adc_init()

{ 

ADCSRA |= _BV(ADEN);//uruchomienie przetwornika

ADCSRA |= _BV(ADPS2);//ustawienie preskalera

ADCSRA |= _BV(ADPS1);//^

ADCSRA |= _BV(ADPS0);//^

ADMUX |= _BV(REFS0);// napiecie odniesienia ustawione jako napiecie zasilania

ADMUX |= ADMUX &= 0b11110000; //wybranie wejscia ADC0 do pomiaru

}

void timers_init()

{

cli(); // obsloga przerwan zabroniona

//timer0 init

TCCR0A |= _BV(COM0A1) | _BV(COM0B0) | _BV(COM0B1) | _BV(WGM00); 

TCCR0B |= _BV(CS01); //preskaler 8

TIMSK0 |= _BV(TOIE0); //flaga od wartosci 0 wlaczona

//timer1 init

TCCR1A |= _BV(COM1A1) | _BV(COM1B0) | _BV(COM1B1) | _BV(WGM10); 

TCCR1B |= _BV(CS11); //preskaler 8

//timer2 init

TCCR2A |= _BV(COM2A1) | _BV(COM2B0) | _BV(COM2B1) | _BV(WGM20); 

TCCR2B |= _BV(CS21); //preskaler 8

//zerowanie wartosci liczników

TCNT0 = 0;

TCNT1L = 0;

TCNT2 = 0;

/* licznik zlicza w góre do 255, nastepnie w dó³: /\/\/\

przy wartosci 255 jest przerwanie przy ktorym dokonuje sie

pomiarow napiec i pradow 

*/

sei(); //zezwolenie na obsloge przerwan

}

void io_init()

{

pinMode(6, OUTPUT); //OC0A

pinMode(5, OUTPUT); //OC0B

pinMode(9, OUTPUT); //OC1A

pinMode(10, OUTPUT);//OC1B

pinMode(11, OUTPUT);//OC2A

pinMode(3, OUTPUT); //OC2B

pinMode(2, INPUT);

pinMode(4, INPUT);

pinMode(12, OUTPUT); 

pinMode(13, OUTPUT);

}

ISR(TIMER0_OVF_vect) //przerwanie przy wartosci 0 licznika0 

{

analog = ADC;

if(a) 

{

U_in = 0.0709*analog;

ADMUX |= _BV(MUX0); //wybranie wejscia ADC1 do pomiaru pradu 

}

else 

{

ADMUX |= ADMUX &= 0b11110000; //wybranie wejscia ADC0 do pomiaru napiecia

if(analog>579) 

{

blad = 0; //jezeli przeciazenie wylaczenie generacji napiecia

digitalWrite(12, HIGH); //zapalenie diody 

}

}

ADCSRA |= _BV(ADSC);//start odczytywania pomiaru

a=a^1; //bramka XOR neguje wartosc logiczna a 

licznik_glowny++;

if(licznik_glowny>=dlugosc_tab_sin) licznik_glowny = 0;

} 

void zmien_predkosc()

{

t_param = map(analogRead(3),0,1023,0,100);

U_rms_max = U_in*0.62; //wartosc 0.62 wyzanczona eksperymentalnie

bool up; //zmienna logiczna, informuje o nacisnietym przycisku zwieksz czestotliwosc

bool down; //zmienna logiczna, informuje o nacisnietym przycisku zmiejsz czestotliwosc

up = digitalRead(4); //odczyt: czy nacisniety przycisk zwieksz czestotliwosc

down = digitalRead(2); //odczyt: czy nacisniety przycisk zmiejsz czestotliwosc

if(up==1) t_param--; //jezeli nacisniety przycisk zwieksz czestotliwosc to zmiejsz okres

if(down==1) t_param++; //jezeli nacisniety przycisk zmniejsz czestotliwosc to zwieksz okres

if(t_param<0) t_param=0; //zabezpieczenie przekroczenia wartosci skrajnych if(t_param>100) t_param=100;//^

dlugosc_tab_sin = ceil((K_MAX-K_MIN)*t_param/500+K_MIN);//ilosc wartosci wypelnien w jednym okresie

t_out = T_PWM*dlugosc_tab_sin; //obliczenie okresu napiecia wyjsciowego

omega_t = t*2*PI/t_out; //obliczenie pulsacji napiecia wyjsciowego

U_o_param = (P/t_out)/U_rms_max; //obliczenie parametru okreslajacego wielkosc napiecia wyjsciowego

if(t_out>1) U_o_param = 0.5*(18.5/U_rms_max); //napiêcie na wyjsciu przy niskiej czestotliwosci 10V

if(U_o_param>1) U_o_param=1; //zabezpieczenie przekroczenia wartosci skrajnych

blad = 1; //jezeli przeciazenie wylaczenie generacji napiecia

//digitalWrite(13, HIGH); //zapalenie diody

//jezeli przeciazenie wylaczenie generacji napiecia

digitalWrite(12, LOW); //zapalenie diody 

}

ความคิดเห็น

แสดงความคิดเห็น

โพสต์ยอดนิยมจากบล็อกนี้

"Who am I" ? By Lord Krishna Revealed in Bhagvad Gita (in Hindi)​#ถ้าฉันเป็นนารายณ์จะร่ายเวทย์#อันเรืองเดชศักดิ์สิทธิ์และรักษา#สันติสุข #สันติธรรม #นำประชา#เจริญผาสุขสันต์นิรันดร#ถ้าฉันเป็นพิฆเนศวิเศษสุทธิ์#จะรีบรุดนำวิชามาสั่งสอน#ใส่เชิงศิลป์#พิณเพลงบรรเลงพร​#ทั้งกาพย์กลอนรื่นเริงเชิงกวี...#ถ้าฉันเป็นพระอินทร์ถวิลไว้#จะสั่งให้วิสุทกรรมนำสุขี#ลงมาสร้างเคหาทุกธานี#ให้ท่านมีสุขเท่าเจ้าเมืองบน...#ถ้าฉันเป็นกามเทพเทวบุตร#จะฉวยฉุดสอยบุบผาเป็นห่าฝน​#ชโลมลูบจูบดวงใจให้ทุกคน#เป็นสุขล้นทุกข์สลายมลายไป... #แต่นี่ฉันใช่เป็นเช่นกล่าวอ้าง#สุดหนทางที่จะทำดังคำไข#จึงขอเขียนบทกลอน#อันอำไพเพื่อเตือนใจ​#เตือนตนทุกคนเอย#สวัสดิรักษา#อย่าเล่นกับไฟ#ไกลกังวล #ดนตรีชีวิต #ผิดเป็นครู #ภูเขาหิน #เรื่องกินเรื่องใหญ่ #ไฟในอย่านำออก #ความหลอกลวง #บ่วงความรัก#สลักจิต #สันติรส #ถ่มน้ำลายรถฟ้า #ก่ิ้งก่าได้ทอง #ครองสันติสุข#สามแดนโลกธาตุ#หาที่จะหยั่งเท้าลงไม่ได้เลย#จิตใจที่แห้งสนิทจึงจะหลุดพ้น#ความหลุดพ้น #วันปิดสามแดนโลกธาตุ​#ถ้ารู้ว่าเราหลงทางเราจะกลับบ้านถูก#อริยสัจ4#การเจริญมรณสติเพื่อความสิ้นอาสวะ #การเข้าผลสมาบัติ#เป็นการเข้าอยู่ในอารมณ์พระนิพพาน#ที่ได้มาจากอริยผลญาณ #อันบังเกิดแล้วแก่ตน #เพื่อเสวยโลกุตตรสุข #ซึ่งเป็นความสงบสุขที่พึงเห็น #ประจักษ์ได้ในปัจจุบัน #พระนิพพาน ที่เป็นอารมณ์ของผลสมาบัตินั้นมีชื่อ ๓ ชื่อหรือมี ๓ อาการคือ ๑. ​#อนิมิตตนิพพาน หมายถึงว่า ผู้ที่ก้าวขึ้นสู่มัคคผลนั้น เพราะเห็นความ ไม่เที่ยง อันปราศจากนิมิตเครื่องหมาย คือ อนิจจัง โดยบุญญาธิการแต่ปางก่อน แรงด้วยสีล เมื่อเข้าผลสมาบัติก็คงมีอนิมิตตนิพพาน เป็นอารมณ์ ๒. #อัปปณิหิตนิพพาน หมายถึงว่า ผู้ที่ก้าวขึ้นสู่มัคคผลนั้น เพราะเห็นความ ทนอยู่ไม่ได้ ต้องเปลี่ยนแปรไป อันหาเป็น ปณิธิ ที่ตั้งไม่ได้ คือทุกขัง โดยบุญญาธิ การแต่ปางก่อนแรงด้วยสมาธิ เมื่อเข้าผลสมาบัติ ก็คงมี อัปปณิหิตนิพพาน เป็น อารมณ์ ๓. ​#ญตนิพพาน หมายถึงว่า ผู้ที่ก้าวขึ้นสู่มัคคผลนั้น เพราะเห็นความ ไม่ใช่ตัวตน บังคับบัญชาไม่ได้ อันเป็นความว่างเปล่า คืออนัตตา โดยบุญญาธิการ แต่ปางก่อนแรงด้วยปัญญา เมื่อเข้าผลสมาบัติ ก็คงมี สุญญตนิพพาน เป็นอารมณ์

#พระธรรมเทศนาโดยพระราชพรหมยานเถระ #วิมุตติความหลุดพ้น #เมื่อใดบุคคลพิจารณาเห็นโลกเสมอด้วยหญ้าและไม้ด้วยปัญญา #เมื่อนั้นบุคคลนั้นย่อมไม่ยึดถือว่าเป็นของเราย่อมไม่เศร้าโศกว่าของเราไม่มี #บุคคลผู้บรรลุธรรมอันสูงสุดแล้วไม่มีความต้องการอะไรในโลกทั้งปวงย่อมไม่เศร้าโศกในเวลาตายดุจบุคคลออกจากเรือนที่ถูกไฟไหม้ฉะนั้น #สิ่งใดสิ่งหนึ่งซึ่งมีอยู่ในโลกนี้ก็ดีภพที่สัตว์ย่อมได้ในโลกนี้ก็ดีพระพุทธเจ้าแสวงหาคุณ อันใหญ่ได้ตรัสไว้ว่าสิ่งทั้งหมดนี้ไม่เป็นอิสระ #ผู้ใดรู้แจ้งธรรมข้อนั้น เหมือนดังที่พระพุทธเจ้าทรงแสดงไว้ผู้นั้นย่อมไม่ยึดถือภพอะไร ดัง บุคคลผู้ไม่จับก้อนเหล็กแดงอันร้อนโชน ฉะนั้น เราไม่ได้มีความคิดว่า ได้มีมาแล้ว จักมีต่อไป หรือสังขารจักปราศจากไป จะคร่ำครวญไปทำไมในเพราะสังขารนั้นเล่า ดูกรนายโจร ความกลัวย่อมไม่มีแก่ผู้พิจารณาเห็นตามความเป็นจริง ซึ่งความเกิดขึ้นแห่งธรรมอันบริสุทธิ์ และความสืบต่อแห่งสังขารอันบริสุทธิ์ เมื่อใดบุคคลพิจารณาเห็นโลกเสมอด้วยหญ้าและไม้ด้วยปัญญา เมื่อนั้น บุคคลนั้นย่อมไม่ยึดถือว่าเป็นของเรา ย่อมไม่เศร้าโศกว่า ของเราไม่มี เรารำคาญด้วยสรีระ ไม่ต้องการด้วยภพ ร่างกายนี้จ...
อ่านเพิ่มเติม