servo_control.py

# هذا العمل مرخص بموجب ترخيص MIT.
# حقوق النشر (c) 2013-2024 OpenMV LLC. جميع الحقوق محفوظة.
# https://github.com/openmv/openmv/blob/master/LICENSE
#
# مثال التحكم بمحرك السيرفو
#
# يوضح هذا المثال كيفية استخدام كاميرا OpenMV للتحكم بمحركات السيرفو.
#
# تحتاج المحركات السيرفو (servos) إلى إشارة PWM بتردد 50 Hz وعرض نبضة من 1000us إلى 2000us.

import time
from machine import PWM

# قد يشترك P7 وP8 في نفس وحدة PWM لذا يجب
# أن يكون لها نفس التردد.
p7 = PWM("P7", freq=50, duty_ns=(2000 * 1000))
p8 = PWM("P8", freq=50, duty_ns=(2000 * 1000))

# قد يشترك P9 وP10 في نفس وحدة PWM لذا يجب
# أن يكون لها نفس التردد.
p9 = PWM("P9", freq=50, duty_ns=(2000 * 1000))
p10 = PWM("P10", freq=50, duty_ns=(2000 * 1000))


while True:
    for i in range(1000, 2000, 100):
        p7.duty_ns(i * 1000)
        p8.duty_ns(i * 1000)
        p9.duty_ns(i * 1000)
        p10.duty_ns(i * 1000)
        time.sleep_ms(1000)

    for i in range(2000, 1000, -100):
        p7.duty_ns(i * 1000)
        p8.duty_ns(i * 1000)
        p9.duty_ns(i * 1000)
        p10.duty_ns(i * 1000)
        time.sleep_ms(1000)