|
273 | 273 | "\n", |
274 | 274 | "For the control loop itself, we use all previous functions. The idea here is to show that the norm of the error decreases with the control action. The desired task space vector will not always be achievable. Nonetheless, we can show, as below, that the control action reduces the task-space error, $\\tilde{\\myvec{x}}$.\n", |
275 | 275 | "\n", |
276 | | - "Let $\\eta=0.5$ be the controller gain and $T=0.001$ be the sampling time. In addition, let the manipulator start at $t=0$ with $q_0=q_1=0$.\n" |
| 276 | + "Let $\\eta=0.5$ be the controller gain, $T=0.001$ be the sampling time, and $\\myvec{x}_d=\\left[\\begin{array}{ccc} 0.1 & 0.1 & \\frac{\\pi}{10} \\end{array}\\right]^T$. In addition, let the manipulator start at $t=0$ with $q_0=q_1=0$.\n" |
277 | 277 | ] |
278 | 278 | }, |
279 | 279 | { |
280 | 280 | "cell_type": "code", |
281 | | - "execution_count": 33, |
| 281 | + "execution_count": null, |
282 | 282 | "metadata": {}, |
283 | 283 | "outputs": [ |
284 | 284 | { |
|
297 | 297 | "q_1 = 0.0\n", |
298 | 298 | "q = np.array([q_0,q_1])\n", |
299 | 299 | "\n", |
300 | | - "\n", |
301 | 300 | "# A desired task-space value, defined by the problem at hand\n", |
302 | | - "xd = np.array([0.1,0.1,pi/10])\n", |
| 301 | + "xd = np.array([0.1,\n", |
| 302 | + " 0.1,\n", |
| 303 | + " pi/10])\n", |
303 | 304 | "print(f\"xd = {xd}\")\n", |
304 | 305 | "\n", |
305 | 306 | "# Define a stop criteria, in this case let's control for 10 seconds\n", |
|
403 | 404 | "cell_type": "markdown", |
404 | 405 | "metadata": {}, |
405 | 406 | "source": [ |
406 | | - "with that, our controller becomes" |
| 407 | + "with that, our controller becomes, changing only the inversion strategy," |
407 | 408 | ] |
408 | 409 | }, |
409 | 410 | { |
|
437 | 438 | "q_1 = 0.0\n", |
438 | 439 | "q = np.array([q_0,q_1])\n", |
439 | 440 | "\n", |
440 | | - "\n", |
441 | 441 | "# A desired task-space value, defined by the problem at hand\n", |
442 | | - "xd = np.array([0.1,0.1,pi/10])\n", |
| 442 | + "xd = np.array([0.1,\n", |
| 443 | + " 0.1,\n", |
| 444 | + " pi/10])\n", |
443 | 445 | "print(f\"xd = {xd}\")\n", |
444 | 446 | "\n", |
445 | 447 | "# Define a stop criteria, in this case let's control for 10 seconds\n", |
|
0 commit comments