|
1 | | -#!/usr/bin/env python |
| 1 | +#!/usr/bin/env python3 |
2 | 2 |
|
3 | 3 | """ |
4 | 4 | Used to adjust the position of a motor in an already assembled robot |
5 | 5 | where you can"t move the motor by hand. |
6 | 6 | """ |
7 | 7 |
|
8 | | -from ev3dev.auto import OUTPUT_A, OUTPUT_B, OUTPUT_C, OUTPUT_D |
9 | | -from ev3dev.helper import LargeMotor |
| 8 | +from ev3dev.auto import OUTPUT_A, OUTPUT_B, OUTPUT_C, OUTPUT_D, Motor |
10 | 9 | import argparse |
11 | 10 | import logging |
12 | 11 | import sys |
|
19 | 18 | args = parser.parse_args() |
20 | 19 |
|
21 | 20 | # logging |
22 | | -logging.basicConfig(level=logging.DEBUG, |
| 21 | +logging.basicConfig(level=logging.INFO, |
23 | 22 | format="%(asctime)s %(levelname)5s: %(message)s") |
24 | 23 | log = logging.getLogger(__name__) |
25 | 24 |
|
26 | | -# For this it doesn't really matter if it is a LargeMotor or a MediumMotor |
27 | 25 | if args.motor == "A": |
28 | | - motor = LargeMotor(OUTPUT_A) |
| 26 | + motor = Motor(OUTPUT_A) |
29 | 27 | elif args.motor == "B": |
30 | | - motor = LargeMotor(OUTPUT_B) |
| 28 | + motor = Motor(OUTPUT_B) |
31 | 29 | elif args.motor == "C": |
32 | | - motor = LargeMotor(OUTPUT_C) |
| 30 | + motor = Motor(OUTPUT_C) |
33 | 31 | elif args.motor == "D": |
34 | | - motor = LargeMotor(OUTPUT_D) |
| 32 | + motor = Motor(OUTPUT_D) |
35 | 33 | else: |
36 | 34 | raise Exception("%s is invalid, options are A, B, C, D") |
37 | 35 |
|
|
40 | 38 | sys.exit(1) |
41 | 39 |
|
42 | 40 | if args.degrees: |
43 | | - log.info("Motor %s, move to position %d, max speed %d" % (args.motor, args.degrees, motor.max_speed)) |
| 41 | + log.info("Motor %s, current position %d, move to position %d, max speed %d" % |
| 42 | + (args.motor, motor.position, args.degrees, motor.max_speed)) |
44 | 43 | motor.run_to_rel_pos(speed_sp=args.speed, |
45 | 44 | position_sp=args.degrees, |
46 | | - # ramp_up_sp=500, |
47 | | - # ramp_down_sp=500, |
48 | 45 | stop_action='hold') |
49 | | - motor.wait_for_running() |
50 | | - motor.wait_for_stop() |
51 | | - motor.stop(stop_action='brake') |
52 | | - log.info("Motor %s stopped, final position %d" % (args.motor, motor.position)) |
0 commit comments