Động cơ dc servo

40
C«ng ty TNHH Th¬ng m¹i vµ ph¸t triÓn c«ng nghÖ ng©n giang (Oe-galaxy co.,Ltd.) Tµi liÖu híng dÉn sö dông M« h×nh ®éng c¬ dc servo

Upload: mrcuongcon05

Post on 26-Jun-2015

2.636 views

Category:

Documents


14 download

TRANSCRIPT

Page 1: Động cơ Dc servo

C«ng ty TNHH Th¬ng m¹i vµ ph¸t triÓn c«ng nghÖ

ng©n giang

(Oe-galaxy co.,Ltd.)

Tµi liÖu híng dÉn sö dông M« h×nh

®éng c¬ dc servo

Page 2: Động cơ Dc servo

HƯỚNG DẪN SỬ DỤNG MÔ HÌNH ĐỘNG CƠ DC SERVO

Page 3: Động cơ Dc servo

CHƯƠNG 1: CẤU TẠO VÀ NGUYÊN LÝ HOẠT ĐỘNG CỦA ĐỘNG CƠ DC SERVO

1.1. Khái quát động cơ DC servo

Động cơ DC và động cơ bước vốn là những hệ hồi tiếp vòng hở - ta cấp điện để động cơ quay nhưng chúng quay bao nhiêu thì ta không biết, kể cả đối với động cơ bước là động cơ quay một góc xác định tùy vào số xung nhận được. Việc thiết lập một hệ thống điều khiển để xác định những gì ngăn cản chuyển động quay của động cơ hoặc làm động cơ không quay cũng không dễ dàng.

Hình 1 Một động cơ DC servo trong thực tế

Mặt khác, động cơ servo được thiết kế cho những hệ thống hồi tiếp vòng kín. Tín hiệu ra của động cơ được nối với một mạch điều khiển. Khi động cơ quay, vận tốc và vị trí sẽ được hồi tiếp về mạch điều khiển này. Nếu có bầt kỳ lý do nào ngăn cản chuyển động quay của động cơ, cơ cấu hồi tiếp sẽ nhận thấy tín hiệu ra chưa đạt được vị trí mong muốn. Mạch điều khiển tiếp tục chỉnh sai lệch cho động cơ đạt được điểm chính xác.

Page 4: Động cơ Dc servo

Động cơ servo có nhiều kiểu dáng và kích thước, được sử dụng trong nhiếu máy khác nhau, từ máy tiện điều khiển bằng máy tính cho đến các mô hình máy bay và xe hơi.

Hình 2 Các thành phần của động cơ DC servo

Một động cơ DCservo tiêu biểu gồm có các thành phần chính sau:

Stator: được gắn liền với vỏ động cơ

Rotor: là thành phần tạo chuyển động quay

Chổi than và vành góp: giúp đưa điện vào Rotor

Encoder: hay còn gọi là bộ mã hóa vòng quay, phản hồi xung, đơn vị tính (xung/vòng)

Ngoài ra, Dc servo còn có thể có thêm các thành phần sau:

Phanh điện từ: giúp hãm động cơ trong trường hợp cần thiết

Tachometer : là thành phần phản hổi tương tự, thực chất là một máy phát điện nhỏ, với điện áp phàn hổi được tính bằng (vol/vòng quay)

Page 5: Động cơ Dc servo

1.2. Điều khiển động cơ DCservo

Để điều khiển số vòng quay hay vận tốc động cơ thì chúng ta nhất thiết phải đọc được góc quay của motor.

Một số phương pháp có thể được dùng để xác định góc quay của motor bao gồm tachometer, hoặc dùng biến trở xoay, hoặc dùng encoder. Trong đó 2 phương pháp đầu tiên là phương pháp analog và dùng optiacal encoder (encoder quang) thuộc nhóm phương pháp digital.

Hệ thống optical encoder bao gồm một nguồn phát quang (thường là hồng ngoại – infrared), một cảm biến quang và một đĩa có chia rãnh. Optical encoder lại được chia thành 2 loại: encoder tuyệt đối (absolute optical encoder) và encoder tương đối (incremental optical encoder). Trong đa số các DC Motor, incremental optical encoder được dùng đa số.

Hình 3 Cấu tạo một encoder quang

      Encoder thường có 3 kênh (3 ngõ ra) bao gồm kênh A, kênh B và kênh I (Index). Trong hình trên chú ý rằng có một lỗ nhỏ bên phía trong của đĩa quay và một cặp phat-thu dành riêng cho lỗ nhỏ này. Đó là kênh I của encoder. Cữ mỗi lần motor quay được một vòng, lỗ nhỏ xuất hiện tại vị trí của cặp phát-thu, hồng ngoại từ nguồn phát sẽ xuyên qua lỗ nhỏ đến cảm biến quang, một tín hiệu xuất hiện trên cảm biến. Như thế kênh I xuất hiện một “xung” mỗi vòng quay của motor. Bên ngoài đĩa quay được chia thành các rãnh nhỏ và một cặp thu-phát khác dành cho các rãnh này. Đây là kênh A của encoder, hoạt động của kênh A cũng tương tự kênh I, điểm khác nhau là trong 1 vòng quay của motor, có N “xung” xuất hiện trên kênh A. N là số rãnh trên đĩa và được gọi là độ phân giải (resolution) của encoder. Mỗi loại encoder có độ phân giải khác nhau, có khi trên mỗi đĩa chĩ có vài rãnh nhưng cũng có trường hợp đến hàng nghìn rãnh được chia. Để điều khiển động cơ,

Page 6: Động cơ Dc servo

bạn phải biết độ phân giải của encoder đang dùng. Độ phân giải ảnh hưởng đến độ chính xác điều khiển và cả phương pháp điều khiển. Không được vẽ trong hình 2, tuy nhiên trên các encoder còn có một cặp thu phát khác được đặt trên cùng đường tròn với kênh A nhưng lệch một chút (lệch M+0,5 rãnh), đây là kênh B của encoder. Tín hiệu xung từ kênh B có cùng tần số với kênh A nhưng lệch pha 90o. Bằng cách phối hợp kênh A và B người đọc sẽ biết chiều quay của động cơ. Hãy quan sát hình 3.

Hình 4 Hoạt động của một encoder quang

       Hình trên cùng trong hình 3 thể hiện sự bộ trí của 2 cảm biến kênh A và B lệch pha nhau. Khi cảm biến A bắt đầu bị che thì cảm biến B hoàn toàn nhận được hồng ngoại xuyên qua, và ngược lại. Hình thấp là dạng xung ngõ ra trên 2 kênh. Xét trường hợp motor quay cùng chiều kim đồng hồ, tín hiệu “đi” từ trái sang phải. Bạn hãy quan sát lúc tín hiệu A chuyển từ mức cao xuống thấp (cạnh xuống) thì kênh B đang ở mức thấp. Ngược lại, nếu động cơ quay ngược chiều kim đồng hồ, tín hiệu “đi” từ phải qua trái. Lúc này, tại cạnh xuống của kênh A thì kênh B đang ở mức cao. Như vậy, bằng cách phối hợp 2 kênh A và B chúng ta không những xác định được góc quay (thông qua số xung) mà còn biết được chiều quay của động cơ (thông qua mức của kênh B ở cạnh xuống của kênh A). 

Động cơ Dc servo được điều khiển bởi tín hiệu từ vi điều khiển theo nguyên lý điều khiển độ rộng xung ( Pulse width modulation – PWM), sử dụng mạch cầu H

Page 7: Động cơ Dc servo

Hình 5 Hoạt động của mạch cầu H

Trong hình 5, hãy xem 2 đầu V và GND là 2 đầu (+) và (-) của ắc qui, “đối tượng” là động cơ DC mà chúng ta cần điều khiển, “đối tượng” này có 2 đầu A và B, mục đích điều khiển là cho phép dòng điện qua “đối tượng” theo chiều A đến B hoặc B đến A. Thành phần chính tạo nên mạch cầu H của chúng ta chính là 4 “khóa” L1, L2, R1 và R2 (L: Left, R:Right). Ở điều kiện bình thường 4 khóa này “mở”, mạch cầu H không hoạt động.

Giả sử bằng cách nào đó mà 2 khóa L1 và R2 được “đóng lại” (L2 và R1 vẫn mở), có một dòng điện chạy từ V qua khóa L1 đến đầu A và xuyên qua đối tượng đến đầu B của nó trước khi qua khóa R2 và về GND (như hình 2a).  Như thế, với giả sử này sẽ có dòng điện chạy qua đối tượng theo chiều từ A đến B. Bây giờ hãy giả sử khác đi rằng R1 và L2 đóng trong khi L1 và R2 mở, dòng điện lại xuất hiện và lần này nó sẽ chạy qua đối tượng theo chiều từ B đến A như trong hình 2b (V->R1->B->A->L2->GND). Vậy là chúng ta có thể dùng mạch cầu H để đảo chiều dòng điện qua một “đối tượng” (hay cụ thể, đảo chiều quay động cơ)

Nếu đóng đồng thời 2 khóa ở cùng một bên (L1 và L2 hoặc R1 và R2) hoặc thậm chí đóng cả 4 khóa? Hiện tượng “ngắn mạch” (short circuit), V và GND gần như

Page 8: Động cơ Dc servo

nối trực tiếp với nhau và hiển nhiên ắc qui sẽ bị hỏng hoặc nguy hiểm hơn là cháy nổ mạch xảy ra. Cách đóng các khóa như thế này sẽ làm hỏng mạch cầu H. Để tránh việc này xảy ra, người ta thường dùng thêm các mạch logic để kích cầu H, chúng ta sẽ biết rõ hơn về mạch logic này trong các phần sau.

Giả thiết cuối cùng là 2 trường hợp các khóa ở phần dưới hoặc phần trên cùng đóng (ví dụ L1 và R1 cùng đóng, L2 và R2 cùng mở). Với trường hợp này, cả 2 đầu A, B của “đối tượng” cùng nối với một mức điện áp và sẽ không có dòng điện nào chạy qua, mạch cầu H không hoạt động. Đây có thể coi là một cách “thắng” động cơ (nhưng không phải lúc nào cũng có tác dụng).

Đó là nguyên lý cơ bản của mạch cầu H. Như vậy thành phần chính của mạch cầu H chính là các “khóa”, việc chọn linh kiện để làm các khóa này phụ thuộc vào mục đích sử dụng mạch cầu, loại đối tượng cần điều khiển, công suất tiêu thụ của đối tượng và cả hiểu biết, điều kiện của người thiết kế. Nhìn chung, các khóa của mạch cầu H thường được chế tạo bằng rờ le (relay), BJT (Bipolar Junction Transistor) hay MOSFET (Metal Oxide Semiconductor Field-Effect Transistor).

Hình 6 Mạch cầu H dùng Rơ le

Page 9: Động cơ Dc servo

     Trong mạch cầu H dùng rờ le ở hình 4, 4 diode được dùng để chống hiện tượng dòng ngược (nhất là khi điều khiển động cơ). Các đường kích solenoid không được nối trực tiếp với chip điều khiển mà thông qua các transistor, việc kích các transistor lại được thực hiện qua các điện trở.

Mạch cầu H dùng rờ le có ưu điểm là dễ chế tạo, chịu dòng cao, đặc biệt nếu thay rờ le bằng các linh kiện tương đương như contactor, dòng điện tải có thể lên đến hàng trăm ampere. Tuy nhiên, do là thiết bị “cơ khí” nên tốc độ đóng/mở của rờ le rất chậm, nếu đóng mở quá nhanh có thể dẫn đến hiện tượng “dính” tiếp điểm và hư hỏng. Vì vậy, mạch cầu H bằng rờ le không được dùng trong phương pháp điều khiển tốc độ động cơ bằng PWM. Người ta thay thế rờ le trong mạch cầu H, bằng các tranzitor gọi là các “khóa điện tử” với khả năng đóng/mở lên đến hàng nghìn hoặc triệu lần trên mỗi giây

Hình 7 Mạch cầu H dùng BJT

Page 10: Động cơ Dc servo

Do BJT có thể được kích ở tốc độ rất cao nên ngoài chức năng đảo chiều, mạch cầu H dùng BJT có thể dùng điều khiển tốc độ motor bằng cách áp tín hiệu PWM vào các đường .

Nhược điểm lớn nhất của mạch cầu H dùng BJT là công suất của BJT thường nhỏ, vì vậy với motor công suất lớn thì BJT ít được sử dụng. Mạch điện kích cho BJT cần tính toán rất kỹ để đưa BJT vào trạng thái bão hòa, nếu không sẽ hỏng BJT. Mặt khác, điện trở CE của BJT khi bão hòa cũng tương đối lớn, BJT vì vậy có thể bị nóng…

Hình 8 Mạch cầu H dùng Mosfet

Hình trên minh họa một mạch cầu H dùng MOSFET điển hình với cặp IRF9540 và IRF540

Mạch cầu H dùng MOSFET, hoạt động tương tự như mạch cầu H dùng BJT, tuy nhiên do ưu điểm của các Mosfet là tốc độ đóng mở nhanh, dòng tải lớn do đó được dùng nhiều hơn trong thực tế.

Page 11: Động cơ Dc servo

Nguyên lý điều xung PWM

PWM (pulse width modulation) là biến điệu độ rộng xung, là phương pháp điều chỉnh điện áp ra tải, hay nói cách khác 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. Trong các thiết bị cơ điện tử, thường dùng PWM để điều tốc, mô-men của động cơ DC rất có hiệu quả.

PWM (Pulse Width Modulation) đang đóng vai trò gần như tuyệt đối trong các hệ công suất chuyển mạch SMPS (Switch Mode Power Supply) còn gọi là nguồn xung. Nói một cách khác, nhắc tới nguồn xung thì người ta nghĩ ngay đến PWM.

PWM tạo dựng trên nguyên tắc chuyển lải năng lượng từ A đến B dưới dạng các xung vuông toàn áp (biên độ xung gần với điện áp nguồn cung cấp) liên tiếp. Trong đó mức năng lượng ty lệ thuận với thời gian mở xung (độ rộng xung tính trên đơn vị thới gian.

Tần số xung trong PWM có thể cố định hay biến đổi (thường là cố định tần số xung chuyển mạch). Với tần số cố định, chu kỳ t bằng tổng thời gian mở xung t(on) với thời gian tắt xung t(off).

t = t(on) + t(off) = t1 + t2Ty lệ của thời gian mở trên chu kỳ xung chính là độ sâu điều biến độ rộng xung, đặc trưng thành thuật ngữ "% duty".Ví dụ, tần số xung 1 KHz --> t = 1 ms.Với t(on) = 0,5 ms --> ta có độ rộng xung T=(T1/T2).100% = 50%

Page 12: Động cơ Dc servo

Như vậy Đối với PWM = 25% thì Ut = Umax.25%(V) Đối với PWM = 50% thì Ut = Umax.50% (V) Đối với PWM = 75% thì Ut = Umax.75% (V)

Trong vi điều khiển PIC16F887 có sẵn module PWM ( 2 kênh)

Sử dụng 2 kênh PWM này, ta có thể điều khiển tốc độ động cơ theo ý muốn. Kênh PWM1 được dùng cho chiều thuận của động cơ, PWM2 được dùng cho chiều còn lại của động cơ.

Page 13: Động cơ Dc servo

CHƯƠNG 2: CẤU TẠO VÀ NGUYÊN LÝ HOẠT ĐỘNG CỦA MÔ HÌNH ĐIỀU KHIỂN

ĐỘNGCƠ DC SERVO

2.1. Cấu tạo mô hình động cơ DC Servo

Hình 6 Mô hình động cơ DCServo

Hệ thống mô hình bao gồm các chi tiết sau:

1. Động cơ DC servo có gắn đĩa chia độ2. Bo mạch điều khiển động cơ DC servo

Vi điều khiển PIC16F877A Màn hình hiển thị LCD Relay nguồn Các công tắc điều khiển Các biến trở điều khiển ( các núm xoay) Các chân nối điện

Page 14: Động cơ Dc servo

3. Các chân cắm nguồn, chân cắm động cơ, encoder 4. Vỏ hộp đựng mô hình

5.

Sơ đồ khối toàn bộ mô hình:

Hình 7 Sơ đồ khối mô hình điều khiển động cơ DC Servo

2.2. Mạch điều khiển sử dụng vi điều khiển PIC16f887A

Gồm có 5 khối chính:

2.2.1. Khối điều khiển, gồm có

Vi điều khiển PIC16F877A, làm chức năng điều khiển hoạt động của toàn bộ mạch điện

Màn hình LCD1602 hiển thị các thông số về tốc độ, góc quay của động cơ

Hai biến trở xoay, dùng để cài đặt các thông số về tốc độ, góc quay 1 công tắc gạt đặt thông số, 1 công tắc chọn chiều quay động cơ

Chức năng:

Nhận tín hiệu đầu vào từ bộ Encoder của động cơ DCservo, tín hiệu điều khiển chiều, tín hiệu cài đặt thông số của các biến trở xoay, vi điều khiển PIC16F877A điều khiển hoạt động của động cơ DCservo và hiển thị các thông số đã thu thập được lên LCD hiển thị

Page 15: Động cơ Dc servo

2.2.2. Khối mạch đệm, gồm có: IC khuếch đại thuật toán LM324, tạo các mức logic. Các Transistor khuếch đại tín hiệu điều khiển. Các optocouple cách ly giữa mạch công suất và mạch điều khiển.

Hoạt động:

Nhận tín hiệu điều khiển từ vi điều khiển, IC khuếch đại thuật toán LM324 kiểm tra tính đúng/sai của tín hiệu, cấp tín hiệu điều khiển cho các transistor khuếch đại, thông qua các optocouple cách ly, tín hiệu này được đưa đến mạch công suất.

2.2.3. Khối mạch công suất, gồm có:

Các Mosfet IRF540N, là linh kiện công suất chính Các Tụ không phân cực 474J, giúp chống nhiễu cho mạch công suất

Hoạt động:Tín hiệu điều khiển sau khi được đưa qua các optocouple cách ly, được đưa đến tầng công suất. Tín hiệu này sẽ ra lệnh mở các Mosfet IRF540N theo một logic đã định trước, điều khiển đóng, mở điện vào động cơ điện, điều khiển tốc độ và chiều của động cơ điện.Các tụ 474J mắc giữa các cực động cơ điện, giúp làm giảm các tín hiệu nhiễu sinh ra khi động cơ DCservo hoạt động, làm tăng sự hoạt động tin cậy của toàn bộ mạch điện

2.2.4. Khối động cơ DC servo, gồm có:

Các đèn led báo trạng thái động cơ Các chân điều khiển động cơ

Hoạt động: Nối các đầu tín hiệu vào động cơ điện, và khi mạch hoạt động, tùy theo tín hiệu điều khiển của vi điều khiển, các đèn led sẽ chỉ thị các trạng thái dừng, chiều thuận, chiều ngược của động cơ.

2.2.5. Khối nguồn cung cấp, gồm có:

Đầu vào các chân cắm điện 5V, 12V, 24V Rơ le đóng ngắt điện động lực

Page 16: Động cơ Dc servo

Hoạt động: đây là đường động lực cung cấp toàn bộ nguồn điện cho bo mạch hoạt động, gồm cả nguồn điện điều khiển và nguồn điện mạch công suất. Rơ le được điều khiển bởi tín hiệu từ IC khuếch đại thuật toán LM324. Nếu trạng thái logic đầu ra của vi điều khiển là đúng, Rơ le sẽ cho phép nguồn động lực đi vào mạch động lực, nếu tín hiệu logic có khả năng làm cho mạch chạy sai, rơ le sẽ ngắt điện mạch động lực, bảo vệ động cơ và các linh kiện công suất.

Page 17: Động cơ Dc servo

CHƯƠNG 3: CÁC BÀI THỰC HÀNH ĐỘNG CƠ DC SERVO

BÀI 1GIỚI THIỆU HƯỚNG DẪN BẢNG MẠCH

Mục tiêu:Khi hoàn thành bài học này, bạn sẽ có khả năng định vị, nhận dạng và thao tác được bảng mạch module thực hành động cơ DCservo

THẢO LUẬN KIẾN THỨC CƠ BẢNBảng mạch về bộ điều khiển động cơ DCservo bao gồm mạch điều khiển và động cơ DCservoCác thông số:

Điện áp cung cấp đầu vào: 220VAC, 3A, 50Hz Các đầu điện áp ra: 24VDC-3A, 12VDC-1A, 5VDC-1A

CÁC THUẬT NGỮ VÀ CÁC TỪ MỚI: ADC bộ biến đổi tương tự - số: Vi điều khiển sử dụng bộ ADC sẵn

có trong chíp để đọc tín hiệu từ các biến trở điều chỉnh các thông số RPM: Vỏ vi mạch có hai hàng chân cắm (DIP) : là một kiểu IC mà có cùng

số chân cắm ở cả hai cạnh của IC Cổng: mức thấp nhất hoặc phần chức năng của một gói IC. Ví dụ cổng

PC0 của vi điều khiển là cổng ra của bộ PWM của vi điều khiển Nối dây cứng: ý nói đến các kết nói đã được làm bằng dây đồng cứng

ngược với các kết nối được làm bằng dây đồng mềm hoặc các đầu kẹp kiểm tra

Mạch tích hợp (IC): một thiết bị tổ hợp các hoạt động của nhiều tranzitor, tụ điện, điện trở… trên một vỏ.

LED : các đi ốt phát quang, một đi ốt bán dẫn có thể phát sáng khi có độ lệch phân cực tăng.

Lắp đặt bề mặt : Một IC mà có thể được hàn trực tiếp với bảng mạch. Nó không cần thiết phải gắn thông qua các lỗ hàn trên bảng mạch.

PWM - Pulse width modulation: bộ tạo xung PWM

Page 18: Động cơ Dc servo

1. Màn hình hiển thị LCD 9. Núm thay đổi tốc độ2. Chíp vi điều khiển PIC16f877A 10. Công tắc gạt ( không dùng)3. IC khuếch đại thuật toán LM324N 11. Công tắc đảo chiều động cơ4. Động cơ DCservo có gắn đĩa chỉ thị5. Fet công suất trên mạch cầu H6. Rơ le nguồn7. Núm thay đổi góc quay8. Nút Start 1 2 3 4

9 78

11

10

100

6 5

Page 19: Động cơ Dc servo

1.

Hình 3.1.2 Sơ đồ vị trí các chân cắm

1. Chân cấp nguồn (+5v) 6.Chân nối tới động cơ DC servo (M-)2. Chân nguồn (GND Power) 7. Chân nối tới động cơ DCservo (M+)3. Chân nguồn (GND Ctrl) 8.Chân nguồn Encoder (E-VCC)4. Chân cấp nguồn (+24V) 9.Chân tín hiệu Encoder (E-SIN)5. Chân cấp nguồn (+12V) 10.Chân nguồn Encoder (E-GND)

8910

1 2 3 4 5 6 7

Page 20: Động cơ Dc servo

BÀI 2SỬ DỤNG CÁC CÔNG CỤ

Mục tiêu:Khi hoàn thành bài học này, bạn sẽ có khả năng điều chỉnh các thông số

một cách dễ dàng, học quan sát các thông số hiển thị trên màn hình LCD đúng cách, tạo điều kiện cơ bản cho các bài học sau.

Các kiến thức cơ bản:

1. Biến trở: là một điện trở có thể thay đổi giá trị.

Hình 3.2 1 Biến trở ; hình ảnh thực tế và kí hiệu trên mạch

Khi mắc biến trở vào mạch như hình 3.2.1C thì : khi thay đổi điện trở, điện áp đặt vào bóng đèn sẽ bị thay đổi ( tăng hoặc giảm ) khi điện trở của biến trở (giảm hoặc tăng), Như vậy, biến trở có tác dụng thay đổi điện áp , hoặc thay đổi dòng điện chạy trong mạch kín

2. Công tắc

Dùng để chuyển hướng tín hiệu trong mạch điện

Hình bên mô tả công tắc loại đơn và công tắc 2 hướng.

Page 21: Động cơ Dc servo

Hình 3.2 2 Một loại công tắc gạt

3. Đi ốt phát quang – LED

Là một loại đi ốt bán dẫn nhưng có khả năng phát ra ánh sáng khi có điện áp thuận đặt vào giữa 2 cực của đi ốt.

Hình 3.2 3 Cấu tạo đi ốt phát quang và hình ảnh trong thực tế

4. Màn hình LCD : có khả năng hiển thị hình ảnh hoặc văn bản, một số kí tự đặc biệt. đây là loại LCD 16 kí tự và 2 hàng.

Hình 3.2 4 màn hình LCD 1602 - 2 hàng 16 kí tự

Page 22: Động cơ Dc servo

Màn hình hiển thị LCD trong mô hình được chia thành 2 phần khác nhau, vị trí như sau:

Phần 1: Chỉ thị giá trị tốc độ đặt trước:“speed :xxxx” Trong đó:

“speed” ( Round per minute): nghĩa là số vòng/phút “xxxx” là giá trị tốc độ, có 3 khoảng tốc độ có thể đặt trước là 100

vòng/phút, 200 vòng/phút, 300 vòng/phút Phần 2: Chỉ thị giá trị góc đặt trước: “Ang:xxxx”Trong đó:

“Ang”( angle) có nghĩa là góc “xxxx” là giá trị góc đặt trước, có giá trị trong khoảng 0 đến 360

Mỗi bước nhảy là 45 độ, ví dụ như 0, 45º, 90º, 135º,…,

P 1

P 2

Page 23: Động cơ Dc servo

Các thao tác chính:1. Nối dây nguồn 220 vào nguồn điện 220V, đèn chỉ thị “dừng” trên mạch

điều khiển báo sáng.

2. Dùng các dây nối để kết nối các cọc nối trước mặt Panel thí nghiệm vào mạch điều khiển theo đúng tên theo sơ đồ hình 3.1.2

Hình 3.2 5 Núm xoay đặt tốc độ và đặt góc quay

3. Thay đổi thông số đặt tốc độ động cơ bằng biến trở đặt tốc độ

Vặn biến trở đặt tốc độ theo chiều kim đồng hồ đến khi hết vòng quay của nó, quan sát trên màn hình sẽ hiển thị tốc độ “RPM:0000”

Từ từ quay ngược biến trở ngược chiều kim đồng hồ, quan sát màn hình hiển thị sẽ lần lượt đổi qua các giá trị RPM khác nhau:

o “speed:0100”: tốc độ đặt trước là 100 vòng/phút

o “speed:0200”, tốc độ đặt trước là 200 vòng/phút

o “speed:0300”, tốc độ đặt trước là 300 vòng/phút

4. Thay đổi thông số góc đặt trước bằng biến trở đặt góc

Vặn biến trở đặt góc quay theo chiều kim đồng hồ đến khi hết vòng quay của nó, quan sát trên màn hình sẽ hiển thị góc “Ang:0000”

Page 24: Động cơ Dc servo

Từ từ quay ngước biến trở ngược chiều kim đồng hồ, quan sát màn hình hiển thị sẽ lần lượt đổi qua các giá trị góc Ang khác nhau: 0, 45º 90º, 180º, 360º….

5. Thay đổi chiều quay của động cơ điện bằng công tắc gạt:

Nhìn trên mô hình, có 3 đèn LED chỉ thị trạng thái động cơ : “dừng”, “thuận”, “ngược”

Hình 3.2.6 Các đèn báo chỉ thị trạng thái

Hình 3.2.7 Các công tắc gạt

Ở trạng thái bình thường, đèn “dừng” và một trong 2 đèn “ngược” hoặc “thuận” sẽ báo sáng, giả sử đèn “ngược” sáng

Bật công tắc “đảo chiều”, đèn “thuận” sẽ báo sáng, gạt công tắc ngược trở lại thì đèn “ngược” sẽ sáng. Tất nhiên do động cơ không quay, nên đèn “dừng” sẽ luôn báo sáng.

Page 25: Động cơ Dc servo

BÀI 3ĐẶC TÍNH ĐỘNG CƠ DC SERVO

Mục tiêu:Khi hoàn thành bài học này, bạn sẽ hiểu động cơ DC servo hoạt động

như thế nào, hiểu được các đặc tính động cơ như là góc và tốc độ động cơ sẽ được điều khiển như thế nào.

Kiến thức căn bản:

Khái niệm động cơ DCservo

Đặc tính một động cơ DCservo

Cách hoạt động của encoder

Cách đọc thông số phản hồi của encoder

Hình 3.2.7 Nút Start nằm giữa hai biến trở đặt tốc độ và góc quay

Tiến hành:

1. Đặt tốc độ động cơ là 100 vòng/phút :“speed:0100”

2. Đặt góc quay của động cơ là 90º :”Ang:90º”

3. Dùng tay quay sao cho kim chỉ thị góc quay động cơ ở vị trí 0º

4. Ấn nút Start trên mạch điều khiển, quan sát động cơ quay và dừng sẽ

thấy:

Page 26: Động cơ Dc servo

Trạng thái bình thường Trạng thái lúc sau

Quan sát sẽ thấy, từ vị trí 0º, kim sẽ từ từ quay đến 90º, chỉ thị động cơ đã quay một góc 90º

Với encoder dùng trong mô hình, có số xung/vòng = 500, có nghĩa là động cơ cứ quay được một vòng –tương ứng với 360º thì sẽ có 500 xung được đưa ra, không liên quan tới tốc độ hiện thời của động cơ.

Xung đưa ra từ Encoder sẽ được vi điều khiển PIC16F877A ghi lại, và từ đó sẽ tính ra góc mà động cơ quay được theo công thức:

Góc quay =

Và theo đó, khi động cơ quay được 90º có nghĩa là vi điều khiển đã đếm được số xung từ encoder : 90/360x500 = 125 ( xung).

Giả sử động cơ quay được 180 độ, thì số xung encoder phát ra là bao nhiêu?

Số xung đã nhận = x 500Hay số xung = 180/360 x 500 = 250 (xung)

Page 27: Động cơ Dc servo

Toàn bộ quá trình thực hành như sau:

5

1

2

3

4

Bắt đầu

Dùng tay, quay sao cho kim chỉ thị về vị trí 0º

Quan sát màn hình hiển thị LCD, ghi lại các thông số

Nối dây nguồn 220v vào mạng điện

Quan sát đèn trạng thái “dừng” đã sáng

Quan sát màn hình hiển thị LCD đã có tín hiệu tốc độ, góc quayĐặt tốc độ động cơ là “speed:0100” tức là 100 vòng/phút

Đặt góc quay động cơ là “Ang:90º” tức là 90 độ

Chọn chiều động cơ bằng công tắc gạt

Bấm nút Start trên mạch điều khiển

Quan sát động cơ quay, mang theo kim chỉ thị góc quay

Quan sát các đèn LED chỉ trạng thái động cơ

Chờ đến khi động cơ dừng

Ghi lại các thông số trên màn hình LCD, so sánh với góc quay thực tế của động cơ và tốc độ động cơ khi quay, rút ra nhận xét.

6

Kết thúc

Page 28: Động cơ Dc servo

Lặp lại các bước từ 2 đến 6 với các tốc độ của động cơ và Góc quay khác nhau. Lưu ý đặt các thông số nằm trong giới hạn, như đã nêu ở phần trước.

Góc quay là 270º hay -90º Góc quay là 135º

Góc quay là 0º Góc quay là 90º