robot di gio è a posto
This commit is contained in:
parent
d43acbd32b
commit
2f3636bb7d
2 changed files with 22 additions and 2 deletions
|
|
@ -6,7 +6,7 @@ from pybricks.tools import wait
|
||||||
|
|
||||||
import batteria
|
import batteria
|
||||||
from assi import A
|
from assi import A
|
||||||
from robots import cbrobot as robot
|
from robots import giorobot as robot
|
||||||
|
|
||||||
hub = robot.hub
|
hub = robot.hub
|
||||||
db = robot.db
|
db = robot.db
|
||||||
|
|
@ -16,6 +16,7 @@ def gira_fino_a_quando(gradi: int):
|
||||||
posizione_iniziale = db.angle()
|
posizione_iniziale = db.angle()
|
||||||
gradi_mancanti = gradi - posizione_iniziale
|
gradi_mancanti = gradi - posizione_iniziale
|
||||||
db.turn(gradi_mancanti)
|
db.turn(gradi_mancanti)
|
||||||
|
|
||||||
# dangolo = db.angle()
|
# dangolo = db.angle()
|
||||||
# if angolo < gradi:
|
# if angolo < gradi:
|
||||||
# db.turn(gradi - angolo)
|
# db.turn(gradi - angolo)
|
||||||
|
|
@ -23,7 +24,7 @@ def gira_fino_a_quando(gradi: int):
|
||||||
|
|
||||||
db.use_gyro(True) # abilitiamo il giroscopio
|
db.use_gyro(True) # abilitiamo il giroscopio
|
||||||
# (mm/s, mm/s², deg/s, deg/s²)
|
# (mm/s, mm/s², deg/s, deg/s²)
|
||||||
db.settings(864, 500, 200, 50)
|
db.settings(100, 100, 100, 50)
|
||||||
# max mm/s = 864
|
# max mm/s = 864
|
||||||
# mm/s quadrato = accelerazione
|
# mm/s quadrato = accelerazione
|
||||||
#
|
#
|
||||||
|
|
|
||||||
19
robots.py
19
robots.py
|
|
@ -53,3 +53,22 @@ cbrobot = LazyRobot(
|
||||||
turn_acceleration=DEFAULT_TURN_ACCELERATION,
|
turn_acceleration=DEFAULT_TURN_ACCELERATION,
|
||||||
settle_ms=DEFAULT_GYRO_SETTLE_MS,
|
settle_ms=DEFAULT_GYRO_SETTLE_MS,
|
||||||
)
|
)
|
||||||
|
|
||||||
|
|
||||||
|
giorobot = LazyRobot(
|
||||||
|
name="favhub",
|
||||||
|
top_side=A.UP,
|
||||||
|
front_side=A.RIGHT,
|
||||||
|
left_port=Port.F,
|
||||||
|
right_port=Port.B,
|
||||||
|
left_direction=Direction.COUNTERCLOCKWISE,
|
||||||
|
right_direction=Direction.CLOCKWISE,
|
||||||
|
wheel_diameter=43.2,
|
||||||
|
axle_track=80,
|
||||||
|
use_gyro=True,
|
||||||
|
straight_speed=DEFAULT_STRAIGHT_SPEED,
|
||||||
|
straight_acceleration=DEFAULT_STRAIGHT_ACCELERATION,
|
||||||
|
turn_rate=DEFAULT_TURN_RATE,
|
||||||
|
turn_acceleration=DEFAULT_TURN_ACCELERATION,
|
||||||
|
settle_ms=DEFAULT_GYRO_SETTLE_MS,
|
||||||
|
)
|
||||||
|
|
|
||||||
Loading…
Add table
Reference in a new issue