Engineering
Serieller Roboter
Schicken Sie einen Dreigelenkarm mit 10 kg Nutzlast auf einer quintischen Bahn von einer Pose zur anderen: der PD-Regler jedes Gelenks mit Schwerkraftvorsteuerung folgt auf wenige Zentimeter, und das Schultermoment in Ruhe ist genau die Summe aus Gewicht mal waagerechtem Hebelarm dahinter, am größten mit gestrecktem Arm. Halbieren Sie die Momentgrenzen und die Schulter hält die gestreckte Last nicht mehr, der Arm fällt; schalten Sie die Schwerkraftvorsteuerung ab und er hängt um Schwerkraftmoment durch Verstärkung durch; legen Sie Nutzlast zu und sehen Sie die Schulter sich ihrer Grenze nähern; verlangen Sie einen Punkt außerhalb der Reichweite und der Arm bleibt. Die Motorarbeit wird gegen kinetische und potentielle Energie und Gelenkreibung verbucht.

Was passiert
Ein ebener Dreigelenkarm von 0,5, 0,4 und 0,2 m mit Punktmassen von 12, 8 und 3 kg an den Gliedenden und einer Nutzlast am Werkzeug. Massenmatrix, Coriolis-Vektor und Schwerkraftvektor folgen aus den Jacobi-Matrizen der Punktmassen; jedes Gelenk treibt ein PD-Regler mit Schwerkraftvorsteuerung und Momentgrenze, viskose Reibung in den Gelenken, eine analytische Ellbogen-oben-Rückwärtskinematik und eine quintische Geradenbahn von der Start- zur Endpose. RK4 mit 0,2 ms; die Motorarbeit trifft die Änderung von kinetischer und potentieller Energie plus Reibung bis auf Rundung, und die statischen Gelenkmomente sind die geschlossenen Schwerkraftmomente der Massen jenseits jedes Gelenks.
Zum Ausprobieren
Sehen Sie den Arm die Last entlang der Bahn tragen und lesen Sie das Schultermoment gegen das Schwerkraftmoment; halbieren Sie die Grenzen und der Arm fällt; schalten Sie die Vorsteuerung ab und er hängt durch; zielen Sie außer Reichweite und er bleibt.
Das Modell und seine Grenzen
Ebener Arm mit Punktmassen, ideale Gelenke ohne Spiel oder Motordynamik, PD-Regelung mit Momentbegrenzung, keine Kollision mit sich selbst oder dem Boden. Momente und Fehler sind die dieses idealisierten Arms.
Gleichungen des Moduls
Gleichungen M(q)·q″ + h(q, q′) + g(q) = τ − b·q′ M = Σ m_k·J_kᵀ·J_k, g_j = Σ m_k·g·∂y_k/∂q_j = Σ_(k≥j) m_k·g·(x_(k+1) − x_j) τ_i = clamp(K_p·(q_i* − q_i) − K_d·q_i′ + g_i(q*), ±τ_max) cos q_2 = (w² − l_1² − l_2²)/(2l_1·l_2), s(u) = 10u³ − 15u⁴ + 6u⁵


