|
1 | 1 | import roboticstoolbox as rtb
|
2 |
| -from spatialmath import * # lgtm [py/polluting-import] |
| 2 | +from spatialmath import * # lgtm [py/polluting-import] |
3 | 3 | import argparse
|
4 | 4 | import sys
|
5 | 5 |
|
6 | 6 | parser = argparse.ArgumentParser(description="Puma trajectory demo")
|
7 | 7 | parser.add_argument(
|
8 |
| - '--backend', |
9 |
| - '-b', |
10 |
| - dest='backend', |
11 |
| - default='pyplot', |
12 |
| - help='choose backend: pyplot (default), swift, vpython', |
13 |
| - action='store') |
| 8 | + "--backend", |
| 9 | + "-b", |
| 10 | + dest="backend", |
| 11 | + default="pyplot", |
| 12 | + help="choose backend: pyplot (default), swift, vpython", |
| 13 | + action="store", |
| 14 | +) |
14 | 15 | parser.add_argument(
|
15 |
| - '--model', |
16 |
| - '-m', |
17 |
| - dest='model', |
18 |
| - default='DH', |
19 |
| - action='store', |
20 |
| - help='choose model: DH (default), URDF') |
| 16 | + "--model", |
| 17 | + "-m", |
| 18 | + dest="model", |
| 19 | + default="DH", |
| 20 | + action="store", |
| 21 | + help="choose model: DH (default), URDF", |
| 22 | +) |
21 | 23 | args = parser.parse_args()
|
22 | 24 |
|
23 |
| -if args.model.lower() == 'dh': |
| 25 | +if args.model.lower() == "dh": |
24 | 26 | robot = rtb.models.DH.Puma560()
|
25 |
| -elif args.model.lower() == 'urdf': |
26 |
| - robot = rtb.models.URDF.Puma560() |
| 27 | +elif args.model.lower() == "urdf": |
| 28 | + robot = rtb.models.Puma560() |
27 | 29 | else:
|
28 |
| - raise ValueError('unknown model') |
| 30 | + raise ValueError("unknown model") |
29 | 31 |
|
30 | 32 | print(robot)
|
31 | 33 |
|
32 | 34 | qt = rtb.tools.trajectory.jtraj(robot.qz, robot.qr, 200)
|
33 | 35 |
|
34 |
| -if args.backend.lower() == 'pyplot': |
35 |
| - if args.model.lower() != 'dh': |
36 |
| - print('PyPlot only supports DH models for now') |
| 36 | +if args.backend.lower() == "pyplot": |
| 37 | + if args.model.lower() != "dh": |
| 38 | + print("PyPlot only supports DH models for now") |
37 | 39 | sys.exit(1)
|
38 |
| -elif args.backend.lower() == 'vpython': |
39 |
| - if args.model.lower() != 'dh': |
40 |
| - print('VPython only supports DH models for now') |
| 40 | +elif args.backend.lower() == "vpython": |
| 41 | + if args.model.lower() != "dh": |
| 42 | + print("VPython only supports DH models for now") |
41 | 43 | sys.exit(1)
|
42 |
| -elif args.backend.lower() == 'swift': |
43 |
| - if args.model.lower() != 'urdf': |
44 |
| - print('Swift only supports URDF models for now') |
| 44 | +elif args.backend.lower() == "swift": |
| 45 | + if args.model.lower() != "urdf": |
| 46 | + print("Swift only supports URDF models for now") |
45 | 47 | sys.exit(1)
|
46 | 48 | else:
|
47 |
| - raise ValueError('unknown backend') |
| 49 | + raise ValueError("unknown backend") |
48 | 50 |
|
49 | 51 | robot.plot(qt.q, backend=args.backend)
|
0 commit comments