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

[dtbamboo36]

xin các bác giúp đỡ....!
em đang làm đề tài vi xử lý dùng pic16f877a điều khiển động cơ dc như sau:
+dùng bàn phím ma trận để nhập giá trị để băm xung (từ 000-255).
+dùng lcd hiển thị giá trị từ bàn phím.
+sau khi nhập 3 số,so sánh vói giá trị 256 nếu nhỏ hơn thì xuất ra băm xung điều khiển động cơ;nếu vượt quá thì nhập lại.
em dùng ngôn ngữ probasic để viết,biên dịch thành công nhưng ko chạy đúng yêu cầu,em đã kiểm tra kỹ (nhưng ko pit tai em dốt hay sao nữa) mà ko tim được lỗi...!
mong các bác giúp đỡ..!thành thật cám ơn mọi người
dưới đây là code và mạch mô phỏng của em,xin các bác cho ý kiến...!
nếu chị nào có thể thành ý muốn giúp đỡ cũng được lun...!hi