|
| 1 | +--- |
| 2 | +title: "Mechanics and Kinematics" |
| 3 | +date: 2025-01-10T18:08:19+05:30 |
| 4 | +lastmod: 2025-01-10T18:08:19+05:30 |
| 5 | +author: "ORIGO" |
| 6 | +cover: "cover.png" |
| 7 | +images: |
| 8 | + - "cover.png" |
| 9 | +categories: |
| 10 | + - "category1" |
| 11 | +tags: |
| 12 | + - "mechanics" |
| 13 | + - "gears" |
| 14 | + - "kinematics" |
| 15 | + - "handout" |
| 16 | + - "rignitc" |
| 17 | +draft: false |
| 18 | +katex: true |
| 19 | + |
| 20 | +--- |
| 21 | + |
| 22 | +<!-- Summary --> |
| 23 | +Mechanics and Kinematics |
| 24 | +<!--more--> |
| 25 | + |
| 26 | +--- |
| 27 | + |
| 28 | +## 1. Forward Kinematics |
| 29 | + |
| 30 | +**Concept:** |
| 31 | + |
| 32 | +Forward Kinematics (FK) is the process of calculating the **position and orientation** of a robot’s end-effector (e.g., its gripper or hand) based on known **joint angles** and **link geometry**. |
| 33 | + |
| 34 | +- **Input:** A set of joint angles (e.g., 45°, 90°) |
| 35 | +- **Output:** Cartesian coordinates (X, Y, Z) and orientation of the end-effector. |
| 36 | + |
| 37 | +**How it Works:** |
| 38 | + |
| 39 | +Think of it like giving step-by-step directions: |
| 40 | +> “From the base, rotate the first joint 45°, extend the second link 30 cm, rotate the next joint 90°, and extend the last link 40 cm.” |
| 41 | +
|
| 42 | +Forward kinematics uses mathematics to determine **exactly** where the end-effector ends up after following these instructions. |
| 43 | +It is **deterministic** — meaning, one input gives one clear output. |
| 44 | + |
| 45 | +--- |
| 46 | + |
| 47 | +## 2. Inverse Kinematics |
| 48 | + |
| 49 | +**Concept:** |
| 50 | + |
| 51 | +Inverse Kinematics (IK) does the **opposite** of FK — it determines the **joint angles** needed to position the end-effector at a **desired target location**. |
| 52 | + |
| 53 | +- **Input:** Desired Cartesian coordinates (X, Y, Z) and orientation. |
| 54 | +- **Output:** The joint angles that achieve that pose. |
| 55 | + |
| 56 | +**Why It’s More Complex:** |
| 57 | + |
| 58 | +While FK gives a **single** solution, IK can have: |
| 59 | + |
| 60 | +- **Multiple solutions** (e.g., “elbow up” or “elbow down”). |
| 61 | +- **A single solution**, or |
| 62 | +- **No solution** if the target is outside the robot’s reachable workspace. |
| 63 | + |
| 64 | +IK is vital for **robot path planning**, since we usually know *where* we want the robot to go — not *how* it must move its joints to get there. |
| 65 | + |
| 66 | +--- |
| 67 | + |
| 68 | +## 3. Denavit–Hartenberg (DH) Convention |
| 69 | + |
| 70 | +The **Denavit–Hartenberg (DH) convention** provides a standardized method to assign coordinate frames to each link of a robot manipulator. |
| 71 | +This method simplifies describing the robot’s geometry for both FK and IK analysis. |
| 72 | + |
| 73 | +--- |
| 74 | + |
| 75 | +### Core Idea |
| 76 | + |
| 77 | +The DH convention represents each link using **four parameters**, applied in a specific order to relate one joint to the next. |
| 78 | + |
| 79 | +### The Four DH Parameters |
| 80 | + |
| 81 | +1. **Link Length (a):** Distance between joint axes (common normal). |
| 82 | +2. **Link Twist (α):** Angle between Z-axes of consecutive links, measured about the X-axis. |
| 83 | +3. **Link Offset (d):** Distance along the Z-axis between links (variable for prismatic joints). |
| 84 | +4. **Joint Angle (θ):** Angle about the Z-axis between X-axes (variable for revolute joints). |
| 85 | + |
| 86 | +--- |
| 87 | + |
| 88 | +### The DH Procedure |
| 89 | + |
| 90 | +1. **Assign Frames:** Attach a (X, Y, Z) frame to each joint following DH rules. |
| 91 | +2. **Determine Parameters:** For each pair of frames, find the four DH parameters (a, α, d, θ). |
| 92 | +3. **Create Transformation Matrices:** Use these to form 4×4 homogeneous transformation matrices for each link. |
| 93 | +4. **Multiply Matrices:** |
| 94 | + Combine all transformations to get the total transformation from base to end-effector: |
| 95 | + |
| 96 | + $$ |
| 97 | + T_{total} = T_{base}^0 × T_0^1 × T_1^2 × \ldots × T_{n-1}^n |
| 98 | + $$ |
| 99 | + |
| 100 | +The resulting matrix gives the **position and orientation** of the end-effector relative to the base. |
| 101 | + |
| 102 | +--- |
| 103 | + |
| 104 | + |
| 105 | + |
| 106 | +The figure shows a **2-Link Planar Robotic Arm**. |
| 107 | + |
| 108 | +The goal is to find the mathematical expressions for the **end-effector position (x, y)**, given: |
| 109 | +- Link lengths $ a_1, a_2 $ |
| 110 | +- Joint angles $ θ_1, θ_2 $ |
| 111 | + |
| 112 | +--- |
| 113 | + |
| 114 | +### DH Parameter Table |
| 115 | + |
| 116 | +For the 2-link arm, the robot’s geometry can be represented using a DH table: |
| 117 | + |
| 118 | + |
| 119 | + |
| 120 | +--- |
| 121 | + |
| 122 | +### Transformation Matrices |
| 123 | + |
| 124 | +Each link’s transformation is defined by a **4×4 homogeneous matrix**, based on its DH parameters: |
| 125 | + |
| 126 | + |
| 127 | + |
| 128 | +--- |
| 129 | + |
| 130 | +### Composite Transformation |
| 131 | + |
| 132 | +To find the end-effector’s pose relative to the base: |
| 133 | + |
| 134 | +$$ |
| 135 | +^0T_2 = A_1 × A_2 |
| 136 | +$$ |
| 137 | + |
| 138 | + |
| 139 | + |
| 140 | +This multiplication results in a composite matrix: |
| 141 | + |
| 142 | + |
| 143 | + |
| 144 | +--- |
| 145 | + |
| 146 | +### End-Effector Equations |
| 147 | + |
| 148 | +From the composite transformation matrix $ T_2^0 $: |
| 149 | + |
| 150 | +$$ |
| 151 | +x = a_1 \cos(θ_1) + a_2 \cos(θ_1 + θ_2) |
| 152 | +$$ |
| 153 | +$$ |
| 154 | +y = a_1 \sin(θ_1) + a_2 \sin(θ_1 + θ_2) |
| 155 | +$$ |
| 156 | + |
| 157 | +--- |
| 158 | + |
| 159 | +**Notation Used in Images:** |
| 160 | + |
| 161 | +- $ c_1 = \cos(θ_1) $ |
| 162 | +- $ s_1 = \sin(θ_1) $ |
| 163 | +- $ c_{12} = \cos(θ_1 + θ_2) $ |
| 164 | +- $ s_{12} = \sin(θ_1 + θ_2) $ |
| 165 | + |
| 166 | +--- |
| 167 | + |
0 commit comments