"""低速前进 1 s;确认地面及前方空间安全."""
import time

from libark.robot.hw1.chassis import Chassis


def main() -> None:
    with Chassis() as chassis:
        chassis.enable()
        try:
            end = time.monotonic() + 1.0
            while time.monotonic() < end:
                chassis.set_velocity(0.03, 0.0, 0.0)
                time.sleep(0.02)
            chassis.stop()
            print(chassis.get_state().pose)
        except BaseException:
            chassis.stop()
            raise


if __name__ == "__main__":
    main()