Xây dựng mơ hình trạng thái liên tục của động cơ PMSM:

Một phần của tài liệu BÁO cáo PBL2 kỹ THUẬT điều KHIỂN và tự ĐỘNG hóa đề tài THIẾT kế hệ THỐNG TRUYỀN ĐỘNG điện CHO ĐỘNG cơ ĐỒNG bộ (Trang 38)

CHƯƠNG 2 : TÍNH TỐN MẠCH ĐIỆN TỬ CÔNG SUẤT

4.1.2Xây dựng mơ hình trạng thái liên tục của động cơ PMSM:

4.1 Xây dựng mơ hình tốn học của hệ thống:

4.1.2Xây dựng mơ hình trạng thái liên tục của động cơ PMSM:

Phương trình điện áp stator tổng quát:

Phương trình điện từ thơng stator:

Ta hình dung ra một hệ tọa độ có 2 trục quay dq, quay với vận tốc ω, điều đó có nghĩa là hệ

toạ độ khơng chỉ quay với đồng bộ với vector từ thơng, hệ cịn đứng n so với rotor. Nếu ta chọn vị trí của hệ sao cho trục d trùng với trục của từ thơng cực, khi ấy tọa độ mới chọn chính là hệ tọa độ T4R.

Phương trình biểu diễn quan hệ giữa từ thơng stator và từ thông rotor :

(với ψps

là từ thơng cực)

Vì trục d của hệ tọa độ trùng với trục của từ thông rotor → Thành phần từ thông rotor trục q (vng góc với d) sẽ bằng 0.

Với ψpq = 0

Ngoài ra, điện cảm của cuộn dây stator là khác nhau khi ở đó đỉnh cực Lsd (dọc theo trục d) và ngang cực Lsq (dọc theo trục q). Từ đó, ta có phương trình các thành phần từ thơng :

Phương trình điện áp stator :

P a g e 36 | 60

PBL2: Thiết kế hệ thống truyền động GVHD: TS. Nguyễn Khánh Quang

Thay các phương trình từ thơng vào chương trình điện áp stator và viết dưới dạng các thành phần dq ta có :

Phương trình momen quay :

Phương trình chuyển động :

(Trong đó : , mw là momen quay của động cơ, momen tải J là momen qn tính)

Ta cần xây dựng mơ hình của dịng điện stator, điện áp stator ở 2 trục d,q và tần số góc s. Từ đó ta có hệ phương trình:

P a g e 37 | 60

Tiếp đó, ta có thể xây dựng mơ hình khơng gian trạng thái :

Hình 4.2. Mơ hình khơng gian trạng thái của động cơ

Với giá trị của thơng số trong mạch động lực, ta có:

Tsd = Tsq = LsdRs= LsqRs =06.005.5 = 7.7.10-4 Từ đó, ta có các ma trận :

AfSM = [

P a g e 38 | 60

PBL2: Thiết kế hệ thống truyền động GVHD: TS. Nguyễn Khánh Quang

NSM =[

−1

Vậy mơ hình khơng gian trạng thái của động cơ PMSM trên hệ tọa độ dq là

difs

dt (adsbygoogle = window.adsbygoogle || []).push({});

=[−1298.7

0

4.1.3 Mơ hình tốn học của bộ biến đổi cơng suất:

Vì bộ chỉnh lưu có đầu ra là điện áp cố định, nên ta khơng mơ hình hóa bộ chỉnh lưu, ta chỉ cần mơ hình hóa bộ nghịch lưu. Bộ nghịch lưu được xem là một khâu tỉ lệ Xác định vào/ra bộ nghịch lưu:

+ Vào : điện áp mong muốn: u∗

+ Ra : điện áp cấp cho động cơ:

+ Hệ số khâu tỉ lệ:

Động cơ chạy đúng yêu cầu khi , vậy =1

4.1.4 Khâu chuyển tọa độ uvw (Clarke Transfomation):

Từ 3 đại lượng được đo , , sẽ chuyển thành , trên hệ tọa độ:

Với + + = 0

Để chuyển đổi từ hệ tọa độ hai trục tham chiếu đứng yên sang hệ tham chiếu 3 pha cố định, ta sẽ sử dụng phép biến đổi Clarke ngược.

P a g e 39 | 60

4.1.5 Khâu chuyển tọa độ dq (Park Transfomation):

Sử dụng cơng thức chuyển đổi Park:

Thuận Nghịch

Hình 4.3 Vector chuyển đổi tọa độ

4.1.6 Khâu cảm biến:

+ Khâu phản hồi tốc độ :

Trong các hệ thống trước đây thường dùng máy phát tốc để đo tốc độ thường dùng bộ lọc có thời gian dưới 10 ms.

Mơ hình hàm truyền đạt của encoder :

P a g e 40 | 60

PBL2: Thiết kế hệ thống truyền động GVHD: TS. Nguyễn Khánh Quang

+ Vớilà hệ số khuếch đại của cảm biến.

+ là hằng số thời gian của bộ lọc do Tw < 10ms chọn Tw=5ms

+ Khâu phản hồi dịng điện:

Mơ hình tốn học của phản hồi dịng điện có thể biểu diễn bằng một hệ số khuếch đại Hc. Trong đa số trường hợp khơng u cầu có bộ lọc.

Trong trường hợp cần dùng bộ lọc , một bộ lọc thông thấp được sử dụng. Hằng số thời gian của bộ lọc thường nhỏ hơn 1ms.

4.2 Mơ hình tốn học của cả hệ thống:

Hình 4.4 Mơ hình tốn học của hệ thống (adsbygoogle = window.adsbygoogle || []).push({});

P a g e 41 | 60

4.3 Tổng hợp hệ thống truyền động điện:

4.3.1 Sơ đồ cấu trúc điều khiển của hệ thống:

Hình 4.5 Sơ đồ cầu trúc điều khiển hệ thống

Thiết kế bộ điều khiển và xác định lại các khâu trong bộ điều khiển Bộ điều khiển phải đảm bảo có chất lượng điều khiển tốt để hệ thống có thể đáp ứng được yêu cầu đặt ra của bài tốn. Thiết kế bộ điều khiển bao gồm:

• Xây dựng cấu trúc điều khiển (các mạch vòng điều khiển) dựa trên phương án truyền động đã chọn và mơ hình hóa cấu trúc phần cứng.

• Thiết kế thuật tốn điều khiển cho các mạch vịng. Xác định các tham số điều khiển cho hệ truyền động .

Trong đồ án này ta sử dụng động cơ đồng bộ kích từ vĩnh cửu ( PMSM), nên từ thơng rotor là hằng số (vĩnh cửu), momen tỉ lệ thuận trực tiếp với thành phần dịng isq và isd. Dịng stator chỉ có nhiệm vụ tạo momen chứ khơng có nhiệm vụ tạo từ thơng và vì vậy điều khiển momen điện từ bằng cách chỉnh dòng isq, còn thành phần isd được đặt bằng 0 để đạt được tỉ lệ momen /dòng điện là tối đa. Khi đó cấu trúc điều khiển bao gồm hai mạch vịng:

• Mạch vịng dịng điện.

• Mạch vịng tốc độ.

P a g e 42 | 60

PBL2: Thiết kế hệ thống truyền động GVHD: TS. Nguyễn Khánh Quang

4.3.2 Các khâu trong bộ điều khiển:a, Bộ điều khiển: a, Bộ điều khiển:

Do trong đồ án này ta tiến hành xác định các thông số PI thực nghiệm. Bộ điều khiển PI bao gồm 2 thơng số tỉ lệ và tích phân:

- Khâu tỉ lệ P: làm thay đổi giá trị đầu ra, tỉ lệ với giá trị sai số hiện tại. Đáp ứng tỉ lệ có thể được điều chỉnh bằng cách nhân sai số đó với một hằng số Kp

• Kp càng lớn thì tốc độ đáp ứng càng nhanh.

• Kp càng lớn thì sai số xác lập càng nhỏ (nhưng khơng thể triệt tiêu).

• Kp càng lớn thì các cực của hệ thống có xu hướng di chuyển ra xa trục thực => Hệ thống càng dao động và độ vọt lố càng cao.

• Nếu Kp tăng quá giá trị giới hạn thì hệ thống sẽ dao động khơng tắt dần => Mất ổn định.

Khâu tích phân I: tỉ lệ thuận với cả biên độ sai số lẫn quãng thời gian xảy ra sai số. Khâu tích phân (khi cộng thêm khâu tỉ lệ) sẽ tăng tốc chuyển động của quá trình tới điểm đặt và khử số dư sai số ổn định với một tỉ lệ chỉ phụ thuộc vào bộ điều khiển. Tuy nhiên, vì khâu tích phân là đáp ứng của sai số tích lũy trong q khứ, nó có thể khiến giá trị lọt vố qua giá trị đặt.

•Ki càng lớn thì đáp ứng q độ càng chậm.

• Ki càng lớn thì sai số xác lập càng nhỏ. Đặc biệt hệ số khuếch đại của khâu tích phân bằng vơ cùng khi tần số bằng 0 => triệt tiêu sai số xác lập với hàm nấc.

•Ki càng lớn thì độ vọt lố càng cao.

Phương pháp thực nghiệm xác định thông số cho bộ PI :

Sau khi tính tốn được sai lệch giữa giá trị phản hồi và giá trị đặt, điều chỉnh thông qua bộ PI bằng cách sau:

- Đặt giá trị Ki = 0 để điều chỉnh Kp trước.

P a g e 43 | 60

- Tăng dần Kp cho đến khi đầu ra của vòng điều khiển bắt đầu dao động, ta đặt Kp bằng

½ giá trị vừa rồi

- Tăng dần Ki cho đến khi giá trị phản hồi bám sát với giá trị đặt (adsbygoogle = window.adsbygoogle || []).push({});

- Ta sẽ thực hiện điều chỉnh từ mạch vòng dòng điện trước rồi tới mạch vòng tốc độ sau.

b, Khâu điều khiển tốc độ:

Ở mạch vòng tốc độ, giá trị tốc độ thực w phản hồi từ encoder cùng với đầu vào tốc độ mong muốn w* được đưa vào mạch vòng tốc độ để so sánh với nhau, sai lệch giữa w và w* sẽ đưa vào bộ điều khiển tốc PI, bộ điều khiển sẽ tính tốn ra giá trị isq* mong muốn để đưa vào mạch vòng dòng điện.

Các tham số bộ điều khiển PI: Kp=100 ; Ki = 400

c, Khâu điều khiển dịng:

Sau khi có được giá trị isd và isq thơng qua các bộ chuyển đổi và giá trị isq* từ khâu điều khiển tốc độ. Ta tiếp tục đưa vào mạch vòng tốc độ để so sánh 2 giá trị isq và isq*, sai lệch giữa isq và isq* sẽ đưa vào bộ điều khiển PI để điều chỉnh phù hợp với giá trị mong muốn. Tương tự với isd, nhưng vì ta khơng cần điều khiển từ thơng nên isd* sẽ cho bằng 0.

Các tham số bộ điều khiển PI dòng Isq: Kp = 5 ; Ki = 50 Các tham số bộ điều khiển PI dòng Isd:

Kp=20 ; Ki = 120

d, Khâu phát xung PWM:

Là phương pháp điều chế dựa trên sự thay đổi độ rộng của chuỗi xung vuông, dẫn đến sự thay đổi điện áp ra.

Cùng một lúc có ba van mạch lực dẫn dịng (nếu bỏ qua thời gian trễ vì lý do an tồn), các tín hiệu đặt (mong muốn) mang thông tin về điện ba pha, gọi là các sóng sin chuẩn Ua*, Ub*, Uc*, được so sánh với sóng mang Urc có dạng răng cưa tam giác lưỡng cực.

Đầu ra của các bộ phận so sánh Uadk điều khiển các van S1 và S4; Ub,đk điều khiển các van S3 và S6, Ucdk điều khiển các van S5 và S2.

P a g e 44 | 60

PBL2: Thiết kế hệ thống truyền động GVHD: TS. Nguyễn Khánh Quang

Tỷ số điều chế về biên độ được tính bởi cơng thức :

= ̂

̂

( ̂ là biên độ của điện áp điều khiển (sóng sin chuẩn); ̂ là biên độ tín hiệu sóng răng cưa )

Hình 4.6 Giản đồ xung trạng thái đóng/mở

4.3.3 Chọn mạch Gate Drive:

Do tín hiệu từ điều chế từ PWM thường có nguồn bé, cơng suất nhỏ nên khơng thể kích được cho các van của IGBT nên cần một nguồn ngoài để làm việc đó. Có 2 phần cơ bản trong việc điều khiển đóng cắc các linh kiện cơng suất là: điều khiển phía cao và phía thấp.

Hình 4.7 Ảnh minh họa của IGBT trong mạch nghịch lưu

P a g e 45 | 60

Trong hình trên Q7 và Q8 ln làm việc đối nghịch nhau. Khi Q7 ở trạng thái ON thì Q8 ở trạng thái OFF và ngược lại.

Khi Q7 ở trạng thái mở sang đóng thì chân E của IGBT Q8 chuyển từ ground sang điện áp cao. Do đó muốn tiếp tục kích Q7 đóng thì phải tạo điện áp kích bằng điện áp cần thiết kích ban đầu cộng với điện áp tại chân E. Tín hiệu ra của vi xử lí điều khiển đóng cắt các khóa chỉ có điện áp +5V. Do đó, cần phải có mạch lái để tạo trơi áp cách li đóng cắt phía cao.

Đối với Q8, chân E được nối đất. Do đó điện áp kích Q8 là điện áp cần thiết kích cho IGBT ban đầu, nên việc đóng ngắt khóa phía thấp được thực hiện dễ dàng hơn.

Sử dụng IC IR 2112 làm mạch Gate Drive cho IGBT trong nghịch lưu

Hình 2.5 Sơ đồ chân của IR 2112

4.3.4 Sơ đồ kết nối IR 2112 với vi điều khiển và mạch nghịch lưu.

Hình 4.8 Mạch nguyên lý cấp xung cho nghịch lưu (adsbygoogle = window.adsbygoogle || []).push({});

P a g e 46 | 60

PBL2: Thiết kế hệ thống truyền động GVHD: TS. Nguyễn Khánh Quang

4.3.3 Nguyên lý của hệ thống điều khiển:

•Nguyên lý hoạt động của hệ thống điều khiển:

Ta cấp điện áp xoay chiều từ nguồn vào bộ biến tần, điện áp xoay chiều sẽ được biến đổi thành nguồn một chiều bằng phẳng thông qua bộ chỉnh lưu cầu diode và tụ lọc. Điện áp một chiều này sẽ được đưa vào mạch nghịch lưu ( là hệ thống các van bán dẫn đóng ngắt theo các tín hiệu điều khiển) để biến đổi thành điện áp xoay chiều 3 pha đối xứng ứng với giá trị điện áp mong muốn để cấp cho động cơ. Sau khi cấp nguồn vào động cơ để cho tải hoạt động, các cảm biến sẽ thu thập dữ liệu về tốc độ và dòng điện để phản hồi về các bộ điều khiển.

Cảm biến dòng điện sẽ thu thập giá trị thực từ cuộn stator rồi đưa iu, iv, iw vào bộ biến đổi Clark để thực hiện tính tốn chuyển đổi từ hệ tọa độ (u,v,w) sang hệ tọa độ (α, β). Để thuận tiện và dễ dàng cho việc tính tốn, ta sẽ chuyển các đại lượng xoay chiều ở hệ tọa độ sang các đại lượng một chiều ở hệ tọa độ (dq). Dòng isα và isβ sẽ được đưa vào bộ Park kết hợp với góc θ để tính tốn chuyển đổi thành isq và isd.

P a g e 47 | 60

Ở mạch vòng tốc độ, đầu vào tốc độ mong muốn w* đưa vào mạch vòng tốc độ để so sánh với giá trị thực w phản hồi từ encoder. Sai lệch giữa w* và w sẽ được đưa vào bộ điều khiển PI, bộ điều khiển sẽ tính tốn ra giá trị isq* mong muốn để tiếp tục đưa vào mạch vòng dòng điện để so sánh với giá trị isq có được từ bộ Park, sai lệch giữa isq* và isq sẽ đưa vào bộ điều khiển PI để tính tốn ra giá trị điện áp usq mong muốn. Do từ thông rotor là hằng số nên ta khơng cần điều khiển từ thơng, vì vậy đặt isd* = 0 rồi cho so sánh với isd và tính tốn điều khiển thơng qua bộ PI để tìm ra giá trị usd mong muốn. Sau khi có được usd và usq ta sẽ đưa vào bộ chuyển đổi Park-1 để chuyển các đại lượng

ởhệ (dq) thành đại lượng xoay chiều ở hệ (α, β). usα và usβ chuyển đổi Clark-1 để chuyển các đại lượng ở hệ (u,v,w) sẽ được đưa vào bộ PWM để tính tốn và tạo ra các chum xung kích thích, điều khiển đóng/mở các van của bộ nghịch lưu xoay chiều 3 pha để cấp điện áp phù hợp cho động cơ hoạt động theo mong muốn.

P a g e 48 | 60

PBL2: Thiết kế hệ thống truyền động GVHD: TS. Nguyễn Khánh Quang

4.4 Lập trình thuật tốn điều khiển trên Vi điều khiển:

4.4.1 Lưu đồ thuật tốn của hệ thống:

Hình 4.9 Lưu đồ thuật toán của hệ thống

P a g e 49 | 60

4.4.2 Lập trình thuật tốn điều khiển của hệ thống trên vi điều khiển:#include <Wire.h> #include <Wire.h> #include "EmonLib.h" #define output1 8 #define output2 9 #define output3 10 #define current_inA A0 #define current_inB A1 #define encoder0PinA 2 #define encoder0PinB 3 #define Zsignal 4

//Khai báo encoder

int val;

int encoder0Pos = 0;

int encoder0PinALast = LOW; int n = LOW; int time_H; int time_L; float t_period; float Frequency; unsigned long t; P a g e 50 | 60

PBL2: Thiết kế hệ thống truyền động GVHD: TS. Nguyễn Khánh Quang

float Speed;

//Khai báo cảm biến dòng

float Ia,Ib,Ic; int vol = 230; void setup() { pinMode(current_inA,INPUT); pinMode(current_inB,INPUT); pinMode(encoder0PinA,INPUT_PULLUP); pinMode(encoder0PinB,INPUT_PULLUP); pinMode(Zsignal,INPUT_PULLUP); pinMode(output1,OUTPUT); pinMode(output2,OUTPUT); pinMode(output3,OUTPUT); t=millis(); } void loop() { t=millis();

// Lấy tín hiệu dịng điện

Ia = current_inA.calcIrms(1480); Serial.print("Dong dien = "); Serial.print(Ia);

P a g e 51 | 60

Serial.println(" A"); Ib = current_inB.calcIrms(1480); Serial.print("Dong dien = "); Serial.print(Ib); Serial.println(" A"); Ic= -Ia-Ib; Serial.print("Dong dien = "); Serial.print(Ic); Serial.println(" A"); / Đọc encoder n = digitalRead(encoder0PinA);

if ((encoder0PinALast == LOW) && (n == HIGH)) { // Signal A and B Direction

if (digitalRead(encoder0PinB) == LOW) { encoder0Pos--; (adsbygoogle = window.adsbygoogle || []).push({});

val=1; // Quay theo chiều dương

} else {

encoder0Pos++;

val=-1; // Quay ngược chiều dương

}

P a g e 52 | 60

PBL2: Thiết kế hệ thống truyền động

/ Lấy tín hiệu tốc độ

/ time_H = pulseIn(encoder0PinA,HIGH);

/time_L = pulseIn(encoder0PinA,LOW);

time_H = pulseIn(Zsignal,HIGH); time_L = pulseIn(Zsignal,LOW); t_period = t_period/1000000; //micro s to s Frequency = 1/t_period;

Speed = 60*Frequency; // RPS to RPM Speed = 3.14/30*Speed; // RPM to RAD/S Serial.print(" Speed = "); Serial.print(Speed); Serial.println(" rad/s "); delay(5); } encoder0PinALast = n; } GVHD: TS. Nguyễn Khánh Quang P a g e 53 | 60

PBL2: Thiết kế hệ thống truyền động GVHD: TS. Nguyễn Khánh Quang

Một phần của tài liệu BÁO cáo PBL2 kỹ THUẬT điều KHIỂN và tự ĐỘNG hóa đề tài THIẾT kế hệ THỐNG TRUYỀN ĐỘNG điện CHO ĐỘNG cơ ĐỒNG bộ (Trang 38)