KRC4 Không khớp tư thế: Phân biệt lỗi thời điểm và lỗi khung hình

Một tư thế KRC4 có vẻ đúng ở vòng lặp đầu tiên nhưng khác ở vòng tiếp theo thường bị cho là do độ lệch dụng cụ được áp dụng hai lần. Cách giải thích đó có thể đúng, nhưng không nên là giả định ban đầu. Các giá trị vị trí robot chịu ảnh hưởng của thời điểm thực thi, phép xấp xỉ đường đi, dữ liệu dụng cụ và hệ tọa độ cơ sở đang hoạt động, ngữ nghĩa giữa giá trị được lệnh và giá trị đo được, cũng như cách biểu diễn tọa độ tại thời điểm so sánh.

Một phương pháp chẩn đoán hữu ích là cố định thời điểm và các hệ quy chiếu trước khi bất kỳ ai thay đổi dữ liệu hiệu chuẩn hoặc mastering đã lưu.

Bảo vệ tham chiếu đã được xác nhận trước tiên

Hãy lưu một bản sao lưu đầy đủ của bộ điều khiển và ghi lại phiên bản KSS, model robot, trạng thái mastering, dụng cụ đang hoạt động, hệ tọa độ cơ sở đang hoạt động, dữ liệu tải, chế độ vận hành, mức override và dòng chương trình tại đó quan sát thấy sự không khớp. Ghi lại chính xác các giá trị ở lần lặp thứ nhất và thứ hai. Ảnh chụp màn hình không kèm hệ quy chiếu đang hoạt động và sự kiện lấy mẫu là bằng chứng chưa đầy đủ.

Không hiệu chuẩn lại dụng cụ hoặc hệ tọa độ cơ sở chỉ để khiến một giá trị được báo cáo trông có vẻ đúng. Một hệ quy chiếu bù có thể che giấu lỗi về thời điểm hoặc phép biến đổi, sau đó làm sai lệch mọi chương trình đang hoạt động tốt nhưng sử dụng cùng dữ liệu. Hãy so sánh chương trình đáng ngờ với tham chiếu đã lưu trữ và xác định mọi thay đổi đối với biểu mẫu nội tuyến, chương trình con, ngắt, logic nền hoặc tín hiệu bắt tay PLC.

Các thành phần liên quan của bộ điều khiển có thể được xem xét tại Hệ thống PLC & PAC, còn phần cứng servo và trục thuộc Bộ truyền động & Điều khiển chuyển động. Tuy nhiên, chỉ nên thay thế phần cứng sau khi bằng chứng phần mềm và đo lường đã loại trừ các nguyên nhân liên quan đến hệ quy chiếu và thời điểm.

Tái hiện sự không khớp tại một điểm được kiểm soát

Chạy ở tốc độ giảm theo quy trình an toàn robot của cơ sở. Nếu quy trình cho phép, hãy loại bỏ phép xấp xỉ quanh điểm cần kiểm tra và chèn một điểm đồng bộ hóa có chủ đích bằng hành vi được ghi trong tài liệu dành cho bản KSS đã cài đặt. Chỉ ghi một mẫu sau khi robot đạt đến trạng thái xác định. Lặp lại từ cùng một tư thế bắt đầu để hai biểu đồ có thể so sánh được.

Phép thử phải trả lời bốn câu hỏi: Có lấy mẫu tại cùng một dòng chương trình không? Robot thực tế có đang ở cùng một pha chuyển động không? Dụng cụ và hệ tọa độ cơ sở có giống nhau không? Giá trị đó thể hiện vị trí được lệnh hay vị trí đo được? Nếu bất kỳ câu trả lời nào chưa rõ, chênh lệch số học chưa chứng minh được lỗi hình học.

Vì sao chế độ chạy trước có thể làm thay đổi bằng chứng

KRL chuẩn bị trước các lệnh chuyển động sắp tới để bộ điều khiển có thể hòa trộn đường đi và tránh các lần dừng không cần thiết. Cơ chế nhìn trước này là nền tảng của chuyển động robot mượt mà, nhưng nó có nghĩa là quá trình diễn giải chương trình và chuyển động thực tế không phải lúc nào cũng ở cùng ranh giới lệnh. Một phép gán không liên quan đến chuyển động có thể được đánh giá trong khi robot vẫn đang thực hiện chuyển động trước đó.

Phép xấp xỉ làm điều này dễ nhận thấy hơn. Robot có thể đi qua gần một điểm đã lập trình mà không dừng tại đó, vì vậy vị trí đo được do một lần quét PLC hoặc tác vụ nền ghi lại có thể tương ứng với một điểm khác trên đường đi đã hòa trộn so với kỳ vọng của lập trình viên. Nếu sự không khớp biến mất khi loại bỏ phép xấp xỉ và đồng bộ hóa thực thi, hãy kiểm tra việc lấy mẫu và luồng chương trình trước khi hiệu chuẩn.

Giải pháp đưa vào sản xuất nên duy trì đường đi đã hòa trộn mong muốn. Không nên để mọi điểm ở chế độ chính xác chỉ để đơn giản hóa việc ghi nhật ký. Thay vào đó, hãy định nghĩa một tín hiệu bắt tay xác định thời điểm mẫu dữ liệu hợp lệ và sử dụng hành vi của bộ điều khiển phù hợp với phiên bản phần mềm đã cài đặt.

Làm rõ chuỗi hệ quy chiếu

Một tư thế robot chỉ có ý nghĩa khi đi kèm hệ quy chiếu. Hãy ghi lại chuỗi biến đổi từ thế giới hoặc gốc robot qua hệ tọa độ cơ sở được chọn, cũng như từ mặt bích qua dụng cụ được chọn đến điểm công nghệ. Sau đó xác định xem giá trị được báo cáo mô tả mặt bích, tâm dụng cụ, đường đi được lệnh hay vị trí đo được.

Tìm trong chương trình và các tác vụ liên quan những thay đổi đối với dụng cụ, hệ tọa độ cơ sở hoặc dữ liệu hệ quy chiếu giữa các lần lặp. Biểu mẫu nội tuyến, chương trình con, ngắt hoặc tiến trình nền có thể chọn dữ liệu khác mà không có thay đổi rõ ràng trong khối chuyển động cục bộ. Cần đặc biệt chú ý đến các tham chiếu gián tiếp, vì tên biến hiển thị có thể vẫn không đổi trong khi chỉ mục được chọn đã thay đổi.

So sánh tất cả giá trị trong cùng một hệ quy chiếu đã khai báo. Việc lấy một tư thế tham chiếu theo thế giới trừ cho một tư thế tham chiếu theo hệ tọa độ cơ sở sẽ tạo ra một lỗi trông có vẻ hợp lý nhưng không có ý nghĩa. Tương tự, áp dụng phép biến đổi dụng cụ cho một tư thế vốn đã biểu thị tâm dụng cụ có thể trông giống như độ lệch kép. Hãy thể hiện từng bước biến đổi và hướng của chúng thay vì gộp phép tính vào một biểu thức duy nhất.

Không nhầm góc Euler với hướng vật lý

Các giao diện robot công nghiệp thường biểu diễn hướng bằng ba góc. Những giá trị đó là một cách biểu diễn hướng, không phải các trục vật lý độc lập. Các bộ góc khác nhau có thể mô tả cùng một hướng vật lý, và các giá trị có thể thay đổi đột ngột gần điểm kỳ dị của cách biểu diễn, ngay cả khi dụng cụ chỉ xoay rất ít.

Để chẩn đoán, hãy so sánh các phép biến đổi hoặc một thước đo sai số hướng phù hợp thay vì trừ từng góc hiển thị theo từng thành phần. Chuẩn hóa góc một cách nhất quán và luôn ghi rõ đơn vị. Nếu vị trí tịnh tiến ổn định nhưng các giá trị góc nhảy, hãy kiểm tra cách biểu diễn và việc chọn hệ quy chiếu trước khi quy trách nhiệm cho mastering.

Phân biệt vị trí được lệnh và vị trí đo được

Vị trí được lệnh mô tả mục tiêu đường đi hoặc trạng thái nội suy của bộ điều khiển. Vị trí đo được phản ánh phản hồi từ encoder, do đó bao gồm sai số bám, độ đàn hồi, ảnh hưởng của tải, quá trình ổn định và thời điểm lấy mẫu. Cả hai đều hữu ích, nhưng chúng trả lời những câu hỏi khác nhau.

Hãy ghi lại các giá trị được lệnh và đo được cùng với vận tốc, trạng thái chương trình và một số mẫu tăng đơn điệu. Nếu chênh lệch chỉ tăng trong quá trình tăng tốc rồi giảm sau khi ổn định, bằng chứng hướng đến hành vi bám thông thường hoặc bất thường chứ không phải lỗi hệ quy chiếu cố định. Nếu cả hai cùng bị dịch chuyển bởi một phép biến đổi không đổi, hãy kiểm tra dữ liệu dụng cụ và hệ tọa độ cơ sở.

Xây dựng hợp đồng dữ liệu robot–PLC nguyên tử

PLC có thể dễ dàng kết hợp các tọa độ từ những chu kỳ nội suy robot khác nhau nếu từng giá trị được đọc riêng lẻ. Robot nên sao chép toàn bộ tư thế và ngữ cảnh liên quan vào một cấu trúc truyền ổn định, sau đó chỉ thay đổi số thứ tự hoặc cờ hợp lệ khi quá trình sao chép hoàn tất. PLC đọc toàn bộ cấu trúc, xác nhận số thứ tự không thay đổi và xác nhận mẫu đó.

Hãy bao gồm số dụng cụ, số hệ tọa độ cơ sở, thông tin vị trí được lệnh hay đo được, hệ tọa độ, đơn vị, chế độ robot và dấu thời gian mẫu hoặc bộ đếm chu kỳ. Logic nhận phải từ chối dữ liệu cũ, chưa hoàn chỉnh hoặc có ngữ cảnh không mong đợi. Điều này biến một sự không khớp tư thế mơ hồ thành một lỗi giao tiếp có thể truy nguyên.

Sử dụng mô phỏng như một phép so sánh có kiểm soát

Môi trường mô phỏng chính thức của KUKA hỗ trợ xác thực ngoại tuyến chuyển động robot và hành vi ứng dụng. Mô phỏng có thể giúp tái hiện trình tự chương trình, kiểm tra việc sử dụng hệ quy chiếu và so sánh đường đi xấp xỉ với đường đi chính xác mà không tiêu tốn thời gian sản xuất. Mô phỏng không thay thế việc kiểm tra mastering, tải, độ đàn hồi, phản hồi encoder hoặc thời điểm PLC thực tế, vì vậy hãy xem mô phỏng là một nguồn bằng chứng.

Trình tự quyết định ưu tiên lỗi

Nếu đồng bộ hóa khắc phục sự không khớp

Hãy sửa hợp đồng lấy mẫu, các giả định về phép xấp xỉ hoặc thời điểm của luồng chương trình. Duy trì đường đi sản xuất đã được xác nhận và ghi lại sự kiện khiến một tư thế trở nên hợp lệ.

Nếu lỗi đi theo việc chọn dụng cụ hoặc hệ tọa độ cơ sở

Hãy sửa logic lựa chọn hoặc hướng biến đổi. Chỉ hiệu chuẩn lại khi các kiểm tra vật lý độc lập cho thấy chính hệ quy chiếu được lưu trữ là sai.

Nếu dữ liệu được lệnh và đo được phân kỳ khi đang chuyển động

Hãy kiểm tra dữ liệu tải, cơ cấu, tình trạng servo, sai số bám và thời điểm lấy mẫu. Không che giấu bằng chứng bằng một độ lệch tọa độ.

Kết luận phương pháp luận quan trọng nhất là: sự không khớp tư thế trước hết là vấn đề về bằng chứng, rồi mới là vấn đề hiệu chuẩn. Hãy cố định điểm thực thi, khai báo mọi hệ quy chiếu, so sánh các đại lượng tương đồng và chỉ thay đổi dữ liệu robot lâu dài sau khi đã kiểm tra các giả thuyết về thời điểm và phép biến đổi.