|
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