منصة هندسية تجمع تصميم وبرمجة 3 أنظمة روبوتية متكاملة: روبوت السومو، سيارة التتبع رباعية الدفع، وروبوت تتبع الخط.
1. البحث: يدور الروبوت ببطء حتى يرصد جسماً على بعد أقل من 50 سم.
2. الهجوم: يندفع بأقصى سرعة (100%) باتجاه الهدف لدفعه.
3. الحماية: عند رصد الخط الأبيض للحافة يتوقف فوراً، يرجع، ويدور 180 درجة.
# VEXcode IQ Python - Sumo Robot
from vex import *
brain = Brain()
left_motor = Motor(Ports.PORT1, False)
right_motor = Motor(Ports.PORT6, True)
distance_sensor = Distance(Ports.PORT3)
color_sensor = ColorSensor(Ports.PORT4)
while True:
# التحقق من حافة الحلبة (اللون الأبيض)
if color_sensor.brightness() > 70:
left_motor.spin(REVERSE, 100, PERCENT)
right_motor.spin(REVERSE, 100, PERCENT)
wait(0.5, SECONDS)
left_motor.spin(FORWARD, 80, PERCENT)
right_motor.spin(REVERSE, 80, PERCENT)
wait(0.4, SECONDS)
# البحث عن الخصم والهجوم
elif distance_sensor.object_distance(MM) < 500:
left_motor.spin(FORWARD, 100, PERCENT)
right_motor.spin(FORWARD, 100, PERCENT)
# الدوران للبحث
else:
left_motor.spin(FORWARD, 40, PERCENT)
right_motor.spin(REVERSE, 40, PERCENT)
wait(20, MSEC)
• المحركان الأيمنان على (OUT1, OUT2) والأيسران على (OUT3, OUT4) في L298N.
• أكبر من 30 سم: الهدف بعيد، تتقدم السيارة.
• بين 15 و30 سم: منطقة أمان، تتوقف.
• أقل من 15 سم: الهدف قريب، تتراجع.
// Arduino 4WD Object Follower Robot
#define TRIG_PIN 9
#define ECHO_PIN 10
// أطراف التحكم في المحركات L298N
#define IN1 2
#define IN2 3
#define IN3 4
#define IN4 5
void setup() {
pinMode(TRIG_PIN, OUTPUT);
pinMode(ECHO_PIN, INPUT);
pinMode(IN1, OUTPUT); pinMode(IN2, OUTPUT);
pinMode(IN3, OUTPUT); pinMode(IN4, OUTPUT);
}
long getDistance() {
digitalWrite(TRIG_PIN, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN, LOW);
long duration = pulseIn(ECHO_PIN, HIGH);
return duration * 0.034 / 2;
}
void moveForward() {
digitalWrite(IN1, HIGH); digitalWrite(IN2, LOW);
digitalWrite(IN3, HIGH); digitalWrite(IN4, LOW);
}
void moveBackward() {
digitalWrite(IN1, LOW); digitalWrite(IN2, HIGH);
digitalWrite(IN3, LOW); digitalWrite(IN4, HIGH);
}
void stopCar() {
digitalWrite(IN1, LOW); digitalWrite(IN2, LOW);
digitalWrite(IN3, LOW); digitalWrite(IN4, LOW);
}
void loop() {
long distance = getDistance();
if (distance > 30 && distance < 100) {
moveForward();
} else if (distance < 15 && distance > 0) {
moveBackward();
} else {
stopCar();
}
delay(50);
}
يتتبع الروبوت حافة الخط الأسود (المنطقة الوسطى بين الأبيض والأسود ≈ 50%):
• الخطأ (Error): القيمة المستهدفة (50) − قراءة الحساس.
• التصحيح: يُضرب الخطأ في ثابت التناسب Kp لتعديل سرعة كل محرك بنعومة عند المنعطفات.
# LEGO SPIKE Prime - Proportional Line Follower
from spike import PrimeHub, MotorPair, ColorSensor
from spike.control import wait_for_seconds
hub = PrimeHub()
motors = MotorPair('A', 'B')
color_sensor = ColorSensor('C')
# إعدادات التحكم التناسبي
TARGET_LIGHT = 50 # القيمة الوسطى بين الأبيض (90) والأسود (10)
BASE_SPEED = 40 # السرعة الأساسية
KP = 0.6 # معامل التصحيح (يُعدل حسب حدة المنعطفات)
while True:
current_light = color_sensor.get_reflected_light()
error = TARGET_LIGHT - current_light
turn_rate = int(error * KP)
# توجيه المحركات بسلاسة بناءً على نسبة الخطأ
motors.start(steering=turn_rate, speed=BASE_SPEED)