Niedopasowanie pozy KRC4: oddziel błędy synchronizacji od błędów klatek

Pozycja KRC4, która podczas pierwszej pętli wygląda poprawnie, a podczas kolejnej jest inna, często jest przypisywana podwójnemu zastosowaniu przesunięcia narzędzia. To wyjaśnienie jest możliwe, ale nie powinno być punktem wyjścia. Wartości pozycji robota zależą od czasu wykonania, aproksymacji ścieżki, aktywnego narzędzia i danych bazy, semantyki wartości zadanych i zmierzonych oraz sposobu reprezentacji współrzędnych używanego w punkcie porównania.

Skuteczna diagnostyka zaczyna się od zamrożenia czasu wykonania i układów odniesienia, zanim ktokolwiek zmieni mastering lub trwałą kalibrację.

Najpierw zabezpiecz poprawny punkt odniesienia

Zapisz kompletną kopię archiwalną sterownika i zanotuj wersję KSS, model robota, stan masteringu, aktywne narzędzie, aktywną bazę, dane obciążenia, tryb pracy, override oraz linię programu, przy której obserwowany jest niezgodny wynik. Zapisz dokładne wartości z pierwszej i drugiej iteracji. Zrzut ekranu bez informacji o aktywnym układzie i zdarzeniu próbkowania jest niepełnym dowodem.

Nie kalibruj narzędzia ani bazy tylko po to, aby jedna zgłaszana wartość wyglądała poprawnie. Kompensujący układ odniesienia może ukryć błąd synchronizacji lub transformacji, a następnie zmienić działanie każdego sprawnego programu korzystającego z tych samych danych. Porównaj podejrzany program z zarchiwizowanym punktem odniesienia i sprawdź wszelkie zmiany w formularzach inline, podprogramach, przerwaniach, logice działającej w tle lub uzgodnieniach z PLC.

Odpowiednie komponenty sterownika można znaleźć w kategorii Systemy PLC i PAC, natomiast sprzęt serwonapędów i osi znajduje się w kategorii Napędy i sterowanie ruchem. Wymiana sprzętu powinna jednak nastąpić dopiero wtedy, gdy dowody programowe i pomiarowe wykluczą przyczyny związane z układami odniesienia i czasem wykonania.

Odtwórz niezgodność w kontrolowanym punkcie

Uruchom program ze zmniejszoną prędkością, zgodnie z procedurą bezpieczeństwa robotów obowiązującą w zakładzie. Jeśli proces na to pozwala, usuń aproksymację wokół podejrzanego miejsca rejestracji i wstaw celowy punkt synchronizacji, korzystając z zachowania opisanego dla zainstalowanej wersji KSS. Zarejestruj tylko jedną próbkę po osiągnięciu przez robota zdefiniowanego stanu. Powtórz test z tej samej pozycji początkowej, aby oba przebiegi można było porównać.

Test powinien odpowiedzieć na cztery pytania: Czy próbkowano tę samą linię programu? Czy robot znajdował się w tej samej fazie ruchu? Czy aktywne były to samo narzędzie i ta sama baza? Czy wartość oznaczała pozycję zadaną czy zmierzoną? Jeśli którakolwiek odpowiedź jest nieznana, różnica liczbowa nie dowodzi jeszcze błędu geometrycznego.

Dlaczego przebieg wyprzedzający może zmienić dowody

KRL przygotowuje kolejne instrukcje ruchu z wyprzedzeniem, aby sterownik mógł łączyć ścieżki i unikać niepotrzebnych zatrzymań. To wyprzedzające przetwarzanie ma zasadnicze znaczenie dla płynnego ruchu robota, ale oznacza, że interpretacja programu i rzeczywisty ruch nie zawsze znajdują się na tej samej granicy instrukcji. Przypisanie niezwiązane z ruchem może zostać wykonane, gdy robot nadal realizuje wcześniejszy ruch.

Aproksymacja uwidacznia to jeszcze bardziej. Robot może przejechać blisko zaprogramowanego punktu bez zatrzymania się w nim, dlatego pozycja zmierzona zarejestrowana przez skan PLC lub zadanie działające w tle może odpowiadać innemu punktowi na łączonej ścieżce niż ten, którego oczekuje programista. Jeśli niezgodność znika po usunięciu aproksymacji i zsynchronizowaniu wykonania, przed kalibracją sprawdź próbkowanie i przepływ programu.

Rozwiązanie produkcyjne powinno zachować wymaganą łączoną ścieżkę. Nie pozostawiaj każdego punktu jako dokładnego tylko po to, aby uprościć rejestrację. Zamiast tego zdefiniuj uzgodnienie określające, kiedy próbka danych jest ważna, i użyj zachowania sterownika odpowiedniego dla zainstalowanej wersji oprogramowania.

Wyraźnie zdefiniuj łańcuch układów odniesienia

Pozycja robota ma znaczenie tylko w określonym układzie odniesienia. Zapisz łańcuch transformacji od świata lub korzenia robota przez wybraną bazę oraz od kołnierza przez wybrane narzędzie do punktu procesu. Następnie określ, czy zgłaszana wartość opisuje kołnierz, punkt centralny narzędzia, zadaną ścieżkę czy pozycję zmierzoną.

Przeszukaj program i powiązane zadania pod kątem zmian narzędzia, bazy lub danych układu między iteracjami. Formularz inline, podprogram, przerwanie lub proces działający w tle może wybrać inne dane bez widocznej zmiany w lokalnym bloku ruchu. Szczólną uwagę zwróć na odwołania pośrednie, ponieważ wyświetlana nazwa zmiennej może pozostać taka sama, podczas gdy zmieni się wybrany indeks.

Porównuj wszystkie wartości w jednym określonym układzie. Odejmowanie pozycji odniesionej do świata od pozycji odniesionej do bazy daje błąd wyglądający wiarygodnie, ale pozbawiony znaczenia. Podobnie zastosowanie transformacji narzędzia do pozycji, która już reprezentuje punkt centralny narzędzia, może przypominać podwójne przesunięcie. Pokaż każdy etap transformacji i jego kierunek, zamiast sprowadzać obliczenie do jednego wyrażenia.

Nie myl kątów Eulera z fizyczną orientacją

Interfejsy robotów przemysłowych często przedstawiają orientację za pomocą trzech kątów. Wartości te są reprezentacją orientacji, a nie niezależnymi osiami fizycznymi. Różne zestawy kątów mogą opisywać tę samą orientację fizyczną, a wartości mogą gwałtownie zmieniać się w pobliżu osobliwości reprezentacji, nawet gdy narzędzie obraca się tylko nieznacznie.

Na potrzeby diagnostyki porównuj transformacje lub użyj odpowiedniej miary błędu orientacji, zamiast odejmować poszczególne kąty wyświetlane na ekranie. Normalizuj kąty w spójny sposób i jednoznacznie określaj jednostki. Jeśli translacja jest stabilna, ale wartości kątów skokowo się zmieniają, przed obwinieniem masteringu sprawdź reprezentację i wybór układu odniesienia.

Rozdziel pozycję zadaną i zmierzoną

Pozycja zadana opisuje cel ścieżki sterownika lub stan interpolacji. Pozycja zmierzona odzwierciedla sprzężenie zwrotne z enkoderów, dlatego obejmuje uchyb nadążania, podatność, wpływ obciążenia, stabilizację oraz moment pobrania próbki. Obie wartości są przydatne, ale odpowiadają na różne pytania.

Rejestruj wartości zadane i zmierzone razem z prędkością, stanem programu oraz monotonicznie rosnącym numerem próbki. Jeśli różnica zwiększa się tylko podczas przyspieszania i zanika po ustabilizowaniu, dowody wskazują raczej na normalne lub nieprawidłowe zachowanie nadążania niż na trwały błąd układu odniesienia. Jeśli obie wartości są przesunięte o tę samą stałą transformację, sprawdź dane narzędzia i bazy.

Zbuduj atomowy kontrakt danych między robotem a PLC

PLC może łatwo połączyć współrzędne z różnych cykli interpolacji robota, jeśli każda wartość jest odczytywana niezależnie. Robot powinien skopiować kompletną pozycję i jej kontekst do stabilnej struktury transferowej, a następnie zmienić numer sekwencyjny lub flagę ważności dopiero po zakończeniu kopiowania. PLC odczytuje całą strukturę, potwierdza, że numer sekwencyjny się nie zmienił, i potwierdza odbiór próbki.

Uwzględnij numer narzędzia, numer bazy, oznaczenie pozycji zadanej lub zmierzonej, układ współrzędnych, jednostki, tryb pracy robota oraz znacznik czasu próbki lub licznik cykli. Logika odbiorcza powinna odrzucać nieaktualne, niekompletne dane lub dane z nieoczekiwanym kontekstem. Dzięki temu niejasna niezgodność pozycji staje się możliwym do prześledzenia błędem interfejsu.

Wykorzystaj symulację do kontrolowanego porównania

Oficjalne środowisko symulacyjne KUKA umożliwia weryfikację ruchu robota i zachowania aplikacji poza produkcją. Symulacja może pomóc odtworzyć sekwencję programu, sprawdzić użycie układów odniesienia oraz porównać ścieżki aproksymowane i dokładne bez zajmowania czasu produkcji. Nie zastępuje ona kontroli masteringu, obciążenia, podatności, sprzężenia zwrotnego z enkoderów ani rzeczywistego czasu reakcji PLC, dlatego traktuj ją jako jedno ze źródeł dowodów.

Sekwencja decyzyjna skoncentrowana na usterce

Jeśli synchronizacja usuwa niezgodność

Skoryguj kontrakt próbkowania, założenia dotyczące aproksymacji lub synchronizację przepływu programu. Zachowaj zweryfikowaną ścieżkę produkcyjną i udokumentuj zdarzenie, które oznacza ważność pozycji.

Jeśli błąd zależy od wyboru narzędzia lub bazy

Skoryguj logikę wyboru lub kierunek transformacji. Kalibruj ponownie tylko wtedy, gdy niezależne kontrole fizyczne wykażą, że zapisany układ odniesienia jest nieprawidłowy.

Jeśli dane zadane i zmierzone rozchodzą się podczas ruchu

Sprawdź dane obciążenia, mechanikę, stan serwonapędów, uchyb nadążania i czas pobrania próbki. Nie ukrywaj dowodów za pomocą przesunięcia współrzędnych.

Najważniejszy wniosek metodologiczny jest następujący: niezgodność pozycji jest najpierw problemem dowodowym, a dopiero potem problemem kalibracji. Zamroź punkt wykonania, określ każdy układ odniesienia, porównuj wartości w tych samych warunkach i zmieniaj trwałe dane robota dopiero po sprawdzeniu hipotez dotyczących czasu wykonania i transformacji.