Simulatore di pinza robotica: presa e schiacciamento

Controlli

Ogni controllo rivaluta l’intera presa quando riceve un input, quindi il grafico segue il cursore mentre lo trascini. Non c’è nulla da avviare.

Il pannello sinistro mostra la presa. Ogni cuneo ombreggiato è un cono di attrito tracciato attorno alla normale della faccia del contatto, e la linea tratteggiata tra i contatti è la retta di presa — deve trovarsi dentro entrambi i coni o l’oggetto viene espulso. Lo zig-zag tra la posizione delle dita comandata, tratteggiata, e il tampone sull’oggetto è la cedevolezza in serie che si sta flettendo: quella deflessione è la forza di presa.

Il pannello destro mostra ciò che ottieni per ciò che comandi. La linea inclinata è F = k·Δc finché il servomotore esaurisce la corsa e diventa piatta. La fascia verde è la finestra utilizzabile, il pettine lungo l’asse inferiore è un passo del servomotore per dente e un dente diventa verde quando cade dentro la finestra. Se nessuno lo fa, non esiste un’impostazione che funzioni.

Teoria

Una pinza a due dita ha una regolazione e due limiti, e la regolazione non è nelle stesse unità dei limiti.

I limiti sono forze. Sotto la soglia di scivolamento l’oggetto cade fuori; sopra il limite di schiacciamento viene distrutto:

slip    n·μ·N  ≥  m·(g + a)·SF          →   N ≥ m(g + a)·SF / (μ·n)
crush   N ≤ F_crush

con n = 2 contatti. Il termine di accelerazione non è decorativo — un braccio che muove un carico imprime alcuni g allo strumento, ed è il caso di carico che conta davvero. C’è un terzo limite che il servomotore impone: N ≤ τ/L · k_duty, dove L è il braccio di leva dal centro della leva al contatto e k_duty riduce la coppia di stallo a ciò che il motore può sostenere senza rovinarsi. Quindi il limite reale è min(F_crush, τ·k_duty/L).

La regolazione è una posizione. Un servomotore a controllo di posizione comanda la corsa delle dita, non la forza. A convertire l’una nell’altra è la rigidità in serie k di tutto ciò che sta tra la leva e l’oggetto — flessione del cinematismo, flessione del dito, tampone, oggetto stesso:

N = k · Δc          Δc = how far past first contact you drove the jaws

Quindi la finestra utilizzabile, nelle unità che puoi davvero comandare, è:

Δc_window = ( min(F_crush, τ·k_duty/L) − m(g + a)·SF/(μ·n) ) / k

e scala come 1/k. Questo è tutto il progetto. Un dito stampato rigido è di circa 25 N/mm; un tampone di schiuma mette in serie circa 4 N/mm; una molla di estensione, 0.8; una flessione stampata, 0.35. Contro questi valori, un servomotore risolve circa un grado, quindi sposta le dita di L·(π/180) per passo — 0.524 mm su un braccio di 30 mm. Confronta i due numeri e la risposta non è vicina:

Il terzo fallimento non ha nulla a che fare con la forza. Due contatti puntuali con attrito tengono solo se la retta che li collega è dentro entrambi i coni di attrito. Per dita parallele su un oggetto rastremato si riduce a:

holds  iff  tan(taper) < μ

N non compare da nessuna parte. Premere di più non aiuta, non ha mai aiutato ed è la prima cosa che tutti provano. La dimostrazione completa è in attrito, chiusura delle forze e perché due contatti sono una scommessa.

Algoritmo

Qui non c’è alcuna integrazione — è algebra, più una chiamata al pianificatore di movimento del sito, così l’accelerazione di sollevamento è una vera curva a S e non un numero inventato. A ogni valutazione, in quest’ordine:

1. Il limite di forza del servomotore. F_stall = τ / L, poi la riduzione: F_cont = F_stall · 0.7.
2. ** Pianifica il sollevamento** con il pianificatore a curva a S e prendi la sua accelerazione di picco.
3. La pressione. demand = k · Δc, poi N = min(demand, F_cont) — perché il servomotore si arrende prima della molla.
4. La richiesta, due volte. needStill = m·g·SF/(μ·2) e needMoving = m·(g + a_peak)·SF/(μ·2). La differenza è ciò che costa il movimento.
5. La finestra. limite inferiore = needMoving, limite superiore = min(F_crush, F_cont), e dividi entrambi per k per ottenere l’intervallo di chiusura che puoi comandare.
6. Il controllo della risoluzione. step = L·(π/180). Se window < step non esiste un’impostazione, e il laboratorio lo dice invece di riportare un margine che nessuno può raggiungere.
7. Chiusura di forza, indipendentemente da tutto quanto precede: tan(taper) < μ.
8. Percorri il sollevamento campione per campione, confrontando la richiesta all’accelerazione di quell’istante con la N costante che stai mantenendo, e registra il primo momento in cui la perde.

Il passo 8 è l’unico punto in cui compare il tempo, ed entrambi i lati del confronto sono forze normali — una sottigliezza che vale la pena esplicitare perché, sbagliandola (confrontando la forza di attrito 2μN con una richiesta già divisa per μ), si conta due volte l’attrito e si segnala come fallita ogni presa anche da fermo.

Esperimenti guidati

Ognuno isola una sola variabile. Esegui in ordine; si costruiscono.

1. Una presa che funziona

Carica Una presa che funziona — una fragola tra dita a flessione stampata, con le dita spinte di 2 mm oltre il contatto. Forza di presa 0.70 N contro 0.29 N necessari e limite di schiacciamento di 3 N. La finestra è 7.739 mm e 15 posizioni distinte del servomotore cadono al suo interno.

Cosa osservare: la fascia verde nel pannello destro è ampia e quindici denti del pettine sono verdi. Ecco come appare qualcosa di “progettato”: potresti sbagliare di un intero millimetro in entrambe le direzioni e non cambierebbe nulla.

2. La stessa fragola, dita rigide

Premi P, oppure carica La stessa fragola, dita rigide. Niente dell’oggetto è cambiato. Il dito è passato da 0.35 N/mm a 25 N/mm.

Cosa osservare: la finestra è 71× più stretta, perché 25/0.35 è 71. Scala esattamente come 1/k e puoi verificarlo trascinando il cursore della rigidità e osservando i due numeri muoversi l’uno contro l’altro. Sotto un passo del servomotore, il pettine non ha denti verdi e il verdetto smette di offrire un margine, perché non ce n’è.

3. L’innesto accidentale

Riporta il dito su rigido e fai scorrere gli oggetti con il tasto O: blocco di legno, bullone M6, uovo, bottiglia PET, bicchiere di carta, fragola. Guarda Impostazioni che funzionano.

Cosa osservare: la colonna “posizioni che funzionano” è zero per ogni oggetto del laboratorio, eppure quattro dei sei vengono tenuti perfettamente. Non è una contraddizione — è tutto il meccanismo di una pinza hobbistica. Una pinza rigida non finisce mai dentro la finestra; supera la finestra e resta bloccato al limite di forza del servomotore, 4.11 N, e funziona perché 4.11 N capita essere sotto il limite di schiacciamento di un blocco, un bullone, un uovo e una bottiglia. Il servomotore agisce come un innesto che non hai progettato e che non puoi regolare. Spingi Coppia di stallo del servomotore verso quella di un MG996R e guarda fallire anche la riga dell’uovo: un servomotore più grande rende la pinza peggiore, perché l’innesto accidentale sale oltre l’oggetto.

Il costo di trattenere in questo modo è sull’indicatore Carico del servomotore: il 70% della coppia di stallo, continuamente, cioè circa 0.49 A attraverso un SG90 che non sta girando. Ecco come muoiono i servomotori hobbistici.

4. Premi di più e perdi comunque la presa

Carica Una rastrematura che l’attrito non può trattenere: una bottiglia con facce a 28° e μ 0.45, così il cono di attrito è ±24.2° e la retta di presa cade fuori. Ora trascina Chiusura delle dita da 0.5 mm fino al limite superiore.

Cosa osservare: dieci volte la forza, verdetto identico, perché N si cancella da tan(taper) < μ. Ora lascia invariata la chiusura e trascina invece μ. A 0.50 il cono è ±26.6° e l’oggetto viene ancora espulso; a 0.53 è ±27.9° e viene ancora espulso; a 0.55 il cono raggiunge ±28.8°, supera la rastrematura di 28° e la presa tiene — alla forza qualsiasi tu abbia lasciato. Guarda i cunei del cono nel pannello sinistro aprirsi oltre la retta di presa tratteggiata mentre trascini. Due centesimi di μ fanno la differenza e la pressione non è mai entrata nel ragionamento.

5. Dimensionato sul banco, perso durante il movimento

Carica Dimensionato sul banco, perso durante il movimento: un uovo tra dita con molla, 1.89 N di presa contro 1.63 N necessari da fermo. Tiene. Premi il braccio verso un sollevamento di 250 mm in 0.9 s e non tiene più.

Cosa osservare: la forza di presa non è mai cambiata. L’unica cosa che si è mossa è il movimento. Rallentare il sollevamento da 0.9 s a 1.5 s risolve una presa che una prova sul banco dichiarava corretta, e fallisce dopo 40 ms di movimento — prima che il braccio abbia percorso un centimetro, ed è per questo che sembra che la pinza “l’abbia semplicemente lasciato cadere”. La fascia ombreggiata tra la linea tratteggiata da fermo e la soglia di scivolamento continua nel pannello destro è esattamente ciò che ti costa l’accelerazione.

6. Il braccio di leva compra due cose e ne vende una

Imposta l’oggetto sul blocco di legno, il dito su imbottito e trascina Braccio di leva del dito.

Cosa osservare: il braccio corto è migliore su entrambi gli assi che il laboratorio misura — cinque volte la forza e cinque volte più fine la risoluzione, dallo stesso servomotore. L’ultima colonna è quella che il laboratorio non calcola, perché è aritmetica pura: la corsa delle dita è L·θ, quindi un braccio di 12 mm con una corsa di 120° apre 25 mm e non può aggirare affatto una bottiglia di 65 mm. Il braccio di leva si dimensiona sull’oggetto più grande che devi afferrare, mentre forza e risoluzione sono ciò che ne consegue. Questo è il compromesso, ed è il motivo per cui le pinze professionali usano un cinematismo invece di fissare il dito alla leva.

7. Quanto costa davvero il fattore di sicurezza

Torna al preset funzionante di fragola e flessione e trascina Fattore di sicurezza da 1 a 6.

Cosa osservare: la soglia di scivolamento sale e il limite di schiacciamento non si muove, quindi la finestra si restringe da 8.16 mm a 6.07 mm — da 16 posizioni utilizzabili a 12. Un fattore di sicurezza 6× ti costa un quarto della finestra e nient’altro, il che è economico quando hai a disposizione 8 mm. Sul dito rigido, dove ce ne sono 0.1 mm, lo stesso fattore è la differenza tra un numero e niente. La cedevolezza è ciò che rende sostenibile un fattore di sicurezza.

Cosa osservare

Riunendo i sette punti:

• Due limiti in newton, una regolazione in millimetri. Il tasso di scambio è k, ed è l’unico numero della pinza che puoi scegliere liberamente.
• La finestra scala come 1/k. Non approssimativamente. Dimezza la rigidità, raddoppia esattamente la finestra.
• Il limite è il passo del servomotore, non la tua pazienza. Sotto L·(π/180) non esiste un’impostazione e nessuna modifica al firmware la raggiunge.
• Una pinza rigida funziona andando in stallo. Supera la finestra fino al limite di forza del servomotore e sopravvive solo finché quel limite è sotto la forza di schiacciamento dell’oggetto. Un servomotore più grande alza il limite e comincia a rompere le cose.
• La chiusura delle forze ignora la forza. tan(taper) < μ è un test geometrico e la pressione non vi compare.
• Le prese si dimensionano durante il movimento, non al momento di afferrare. Il termine di accelerazione domina appena il braccio è veloce.

Portarlo sull’hardware

I venti minuti valgono la pena per l’esperimento 3. Chi costruisce una prima pinza prende dita più rigide quando qualcosa scivola, e l’esperimento 3 dimostra che la rigidità era già il problema.

Codice sorgente

Dimensionare una pinza è quattro righe di aritmetica da eseguire prima di stampare qualsiasi cosa.

// --- what the servo can push with ---
const float TAU_STALL = 0.176f;   // N·m, SG90 at 4.8 V — derate for 6 V, derate more when warm
const float DUTY      = 0.70f;    // what it can hold without cooking itself
const float LEVER_MM  = 30.0f;    // horn centre to the contact patch. MEASURE THIS.

float jawForceN() { return (TAU_STALL * DUTY) / (LEVER_MM / 1000.0f); }

// --- what the object demands ---
// F = m(g + a)·SF / (mu · n).  `a` is the arm's peak acceleration, not zero.
float requiredN(float massKg, float mu, float peakAccel, float safety) {
  return (massKg * (9.80665f + peakAccel) * safety) / (mu * 2.0f);
}

// --- the check nobody runs ---
// A servo step of one degree moves the jaws L·(pi/180). If the force window
// divided by the series stiffness is smaller than that, no command works.
bool aimable(float crushN, float slipN, float stiffnessNperMM) {
  float windowMM = (min(crushN, jawForceN()) - slipN) / stiffnessNperMM;
  float stepMM   = LEVER_MM * (PI / 180.0f);
  return windowMM > stepMM;
}

E poi l’azionamento stesso, una volta che l’aritmetica dice che il progetto è possibile. Comanda la posizione chiusa e lascia che la cedevolezza assorba la differenza — non provare a fermarti sull’oggetto:

const int OPEN_US   = 1900;
const int CLOSED_US = 1300;   // past contact, deliberately. The spring absorbs it.

void grip(bool closed) {
  gripper.writeMicroseconds(closed ? CLOSED_US : OPEN_US);
  delay(400);                 // it is a position loop with no feedback to you
}

Lì non c’è retroazione di forza e non serve averla, purché la finestra sia più larga di un passo. Questo è l’intero argomento a favore della cedevolezza ed è il motivo per cui una molla di estensione da 40p sostituisce una cella di carico nella maggior parte delle realizzazioni. Quando vuoi davvero sapere se la presa ha funzionato, la risposta più economica è un microswitch sul dito anziché la misura della corrente — la macchina a stati di prelievo e posizionamento spiega dove mettere il controllo.