3.4.3. Tích hợp hệ thống: Mỗi module trình bày ở trên đã được phát triển một cách riêng biệt.
Để xây dựng toàn bộ hệ thống, chúng ta phải tích hợp các mô-đun. Vả. 18 cho thấy làm thế nào
các module được tích hợp trong hệ thống.
• Bước 1: Các mô-đun định vị sẽ tự động xác định tọa độ của điểm khởi đầu (điểm bắt đầu) của Robot. Đồng thời, hệ thống "lắng nghe" để nhận được
lệnh của người dùng được gửi từ điện thoại thông minh.
• Bước 2: Con đường ngắn nhất tìm module được kích hoạt. Kết quả trả về là quỹ đạo
sáng tác của một tập hợp các điểm trung gian {path = p1, p2, p3, .., pn} trong đó p1 là sự bắt đầu
điểm và điểm dừng PN;
• Bước 3: Đối với mỗi cặp điểm gần kề ở con đường, hệ thống sẽ tính toán khoảng cách
D = dist (pi, pi + 1); • Bước 4: Hệ thống verity điều kiện D> e với e là ngưỡng tối thiểu Robot có thể di chuyển. Trong hệ thống này, chúng tôi thiết lập e = 20cm; • Bước 5: Nếu điều kiện là không hài lòng, hệ thống sao lưu sang Bước 4. Nếu không, nó đi đến Bước 6; • Bước 6: Di chuyển các robot một khoảng cách D. Cụ thể,? Bước 6.1: Khi các robot di chuyển, nó quan sát môi trường. Tại một vị trí hiện tại của robot, chúng tôi thu thập một hình ảnh mỗi giây. Module địa hóa được kích hoạt để xác định vị trí hiện tại của robot. Phương trình đồng thời chuyển động của robot được thiết lập với một vận tốc v cố định. Trong thí nghiệm, chúng tôi thiết lập v = 200mm / s để phù hợp với tốc độ đi bộ của người khiếm thị. Thông tin này được sử dụng để xây dựng các mô hình của Kalman lọc để dự đoán vị trí thực tế của Humanrobot (vị trí pi *).? Bước 6.2: Tính toán khoảng cách D = dist (pi *, pi + 1).? Bước 6.3:. Trong toàn bộ quá trình, các mô-đun phát hiện chướng ngại vật được kích hoạt A phát hiện dương tính thật sự sẽ ngừng chuyển động robot.? Bước 6.4: Lặp lại bước 4 để kiểm tra D và e.
đang được dịch, vui lòng đợi..