Documentos de Académico
Documentos de Profesional
Documentos de Cultura
Robotica II - Clase V - Tema III
Robotica II - Clase V - Tema III
𝑖𝑖
𝜔𝜔𝑖𝑖+1 = 𝜔𝜔𝑖𝑖𝑖𝑖 + 𝑅𝑅𝑖𝑖+1
𝑖𝑖
𝑞𝑞̇ 𝑖𝑖+1 𝑍𝑍̂𝑖𝑖+1
𝑖𝑖+1
𝑖𝑖
– 𝜔𝜔𝑖𝑖+1 = Velocidad angular del sistema i+1 respecto al sistema i
– 𝜔𝜔𝑖𝑖𝑖𝑖 = Velocidad angular del sistema i respecto al sistema i
𝑅𝑅𝑖𝑖𝑖𝑖+1 𝜔𝜔𝑖𝑖+1
𝑖𝑖
= 𝑅𝑅𝑖𝑖𝑖𝑖+1 (𝜔𝜔𝑖𝑖𝑖𝑖 + 𝑅𝑅𝑖𝑖+1
𝑖𝑖
𝑞𝑞̇ 𝑖𝑖+1 𝑍𝑍̂𝑖𝑖+1
𝑖𝑖+1
)
𝝎𝝎𝒊𝒊+𝟏𝟏
𝒊𝒊+𝟏𝟏 = 𝑹𝑹𝒊𝒊+𝟏𝟏 𝒊𝒊
𝒊𝒊 𝝎𝝎𝒊𝒊 + ̇
𝒒𝒒 �
𝒁𝒁𝒊𝒊+𝟏𝟏
𝒊𝒊+𝟏𝟏 𝒊𝒊+𝟏𝟏
𝑖𝑖
𝜔𝜔𝑖𝑖+1 = 𝜔𝜔𝑖𝑖𝑖𝑖
𝝎𝝎𝒊𝒊+𝟏𝟏 𝒊𝒊+𝟏𝟏 𝒊𝒊
𝒊𝒊+𝟏𝟏 = 𝑹𝑹𝒊𝒊 𝝎𝝎𝒊𝒊
𝑖𝑖
𝑣𝑣𝑖𝑖+1 = 𝑣𝑣𝑖𝑖𝑖𝑖 + 𝜔𝜔𝑖𝑖+1
𝑖𝑖+1 𝑖𝑖
𝑥𝑥𝑃𝑃𝑖𝑖+1
𝑖𝑖
– 𝑣𝑣𝑖𝑖+1 = Velocidad lineal del sistema i+1 respecto al sistema i
– 𝑣𝑣𝑖𝑖𝑖𝑖 = Velocidad lineal del sistema i respecto al sistema i
𝒗𝒗𝒊𝒊+𝟏𝟏
𝒊𝒊+𝟏𝟏 = 𝑹𝑹𝒊𝒊+𝟏𝟏 𝒊𝒊
𝒊𝒊 𝒗𝒗 𝒊𝒊+𝟏𝟏 = 𝑹𝑹𝒊𝒊+𝟏𝟏 𝒊𝒊
𝒊𝒊 𝒗𝒗𝒊𝒊 + 𝝎𝝎 𝒊𝒊+𝟏𝟏
𝒊𝒊+𝟏𝟏 𝒙𝒙𝑷𝑷𝒊𝒊
𝒊𝒊+𝟏𝟏
𝑖𝑖
𝑣𝑣𝑖𝑖+1 = 𝑣𝑣𝑖𝑖𝑖𝑖 + 𝜔𝜔𝑖𝑖𝑖𝑖 𝑥𝑥𝑃𝑃𝑖𝑖+1
𝑖𝑖 𝑖𝑖
+ 𝑅𝑅𝑖𝑖+1 𝑑𝑑̇ 𝑖𝑖+1 𝑍𝑍̂𝑖𝑖+1
𝑖𝑖+1
𝑖𝑖+1
𝑣𝑣𝑖𝑖+1 = 𝑅𝑅𝑖𝑖𝑖𝑖+1 𝑣𝑣𝑖𝑖𝑖𝑖 + 𝜔𝜔𝑖𝑖𝑖𝑖 𝑥𝑥𝑃𝑃𝑖𝑖+1
𝑖𝑖 𝑖𝑖
+ 𝑅𝑅𝑖𝑖+1 𝑑𝑑̇ 𝑖𝑖+1 𝑍𝑍̂𝑖𝑖+1
𝑖𝑖+1
𝑖𝑖+1
■ Vel. Angular junta prismática -> 𝜔𝜔𝑖𝑖+1 = 𝑅𝑅𝑖𝑖𝑖𝑖+1 𝜔𝜔𝑖𝑖𝑖𝑖
𝑖𝑖+1
■ Vel. Lineal junta rotacional -> 𝑣𝑣𝑖𝑖+1 = 𝑅𝑅𝑖𝑖𝑖𝑖+1 𝑣𝑣𝑖𝑖𝑖𝑖 + 𝜔𝜔𝑖𝑖+1
𝑖𝑖+1 𝑖𝑖
𝑥𝑥𝑃𝑃𝑖𝑖+1
𝑖𝑖+1
■ Vel. Lineal junta prismática -> 𝑣𝑣𝑖𝑖+1 = 𝑅𝑅𝑖𝑖𝑖𝑖+1 𝑣𝑣𝑖𝑖𝑖𝑖 + 𝜔𝜔𝑖𝑖𝑖𝑖 𝑥𝑥𝑃𝑃𝑖𝑖+1
𝑖𝑖
+ 𝑑𝑑̇ 𝑖𝑖+1 𝑍𝑍̂𝑖𝑖+1
𝑖𝑖+1
𝐝𝐝𝐝𝐝𝐝𝐝 𝑱𝑱𝜽𝜽(𝒕𝒕) ≠ 𝟎𝟎