Điều khiển động cơ servo

[KDD04]

Ai biết thì giúp mình với. Mình đang cần code để điều khiển động cơ theo yêu cầu sau:
Mạch điều khiển động cơ servo:
Nhấn nút ON mở động cơ (coi như đây là nút nhấn cho phép động cơ hoạt động hay điều chỉnh tốc độ).
Nhấn nút OFF động cơ đang quay thì dừng lại.
Nhấn FOR động cơ quay thuận (led đầu tiên hiển thị số 1).
Nhấn REV động cơ quay ngược(led đầu tiên hiển thị số 0).
(Khi chuyển giữa hai chế độ thuận ngược: có thể nhấn trực tiếp không cần phải tắt động cơ (không cần nhấn nút OFF) ).
Các nút số dùng để nạp tốc độ động cơ. Khi nạp tốc độ thì hiển thị lên 3led 7 đoạn.
Đồng thời khi động cơ đang hoạt động ổn định thì cũng hiển thị tốc độ lên 3 led.
Sau khi nạp tốc độ cho động cơ thì nhấn OK động cơ mới hoạt động.
(Mình có sơ đồ nguyên lý mà không biết làm sao post lên).

Falleaf:
http://dientuvietnam.net/forums/showthread.php?t=1419
Xem bài này để biết cách post hình lên diễn đàn