thực ra bài toán này giải quyết bằng các câu lệnh đơn giản là được, bạn mô tả hệ thống của bạn, sau đó đưa ra giải thuật điều khiển rùi lập trình điều khiển ^^!