Below is the following:
--- how the code should work according to chat gpt (I learned just because it perfectly understands how it should work doesn't mean it can generate perfectly working code)
--- the code
--- initial issues with the code
--- Also, any tips for using AI to generate better code is appreciated.
Here is how the code should work as explained back to me by Chat GPT:
Initialization
- Setup the Pins: Configure the pins for the ultrasonic sensors (echo and trigger pins) and the microstep driver (PUL and DIR pins).
- Variables Initialization: Initialize necessary variables to track sensor states, motor states, and timing.
Continuous Monitoring Phase
- Monitor Sensors Continuously: Continuously monitor the readings from both ultrasonic sensors.
- Check for Continuous Triggering:
- If either sensor detects an object within 1.5 feet (45 cm) for at least 3 seconds continuously, prepare to start the motor in direction 1.
Motor Movement Direction 1 (Initial Movement)
- Start Motor Movement (Direction 1):
- Move the motor in direction 1 for a set duration of 11 seconds.
- During this movement, monitoring the sensors is optional but allowed.
Post-Movement Monitoring
- Post-Movement Monitoring:
- After the initial 11-second movement (from Position 1 to Position 2), resume monitoring the sensors for any activity within 1.5 feet.
- Ensure the Path is Clear: Check that no object is detected by either sensor for a continuous period of 3 seconds. This ensures the motor won't move into a potentially obstructed path.
Motor Movement Direction 2 (Reset and Full Movement)
- Start Motor Movement in Direction 2:
- Move the motor in direction 2 while continuously monitoring the sensors.
- Immediate Reversal on Detection: If either sensor detects an object within 1.5 feet during this movement, stop the motor immediately and reverse direction back to direction 1.
Motor Reversal to Direction 1
- Reverse Motor Movement:
- Move the motor back in direction 1 for the appropriate time to return to position 2 after any detection. This could be less than 11 seconds and needs to be timed accurately.
Full Movement in Direction 2 to Reset
- Complete Full Movement in Direction 2:
- Once the motor has returned to position 2 after reversing, continue monitoring the sensors.
- The motor must move in direction 2 for a full 11 seconds with a clear path (no object detected within 1.5 feet) to reset the instructions to the start.
Continuous Loop
- Resume Monitoring:
- Once the full 11-second movement in direction 2 is complete and the path is clear, resume sensor monitoring.
- Path is Clear: Ensure no object is detected for at least 3 seconds continuously before attempting to move in direction 1 again from Position 1.
Summary
-
Sensor Monitoring: Always monitor sensors except during the initial movement in direction 1.
-
Trigger Time: Ensure an object is continuously detected for 3 seconds before starting or stopping motor actions, except for immediate reversal in step 7.
-
Motor Actions:
- Move in direction 1 for 11 seconds after initial trigger.
- Move in direction 2 while ensuring a clear path, stopping immediately and reversing to direction 1 if an object is detected.
- Reverse direction to move back in direction 1 for the appropriate time to return to position 2 after any detection.
- Ensure the motor completes a full 11-second movement in direction 2 with no obstruction to reset instructions.
-
Timing and Distance Constants:
stepDelay is 50 ms.detectionDistance is 45 cm.sensorTriggerTime is 3 seconds.motorMoveTime is 11 seconds for both movements in directions 1 and 2.
Here is the code I have right now, generated from Chat GPT
// Define constants
const int echoPin1 = 4; // Echo pin of sensor 1
const int trigPin1 = 5; // Trigger pin of sensor 1
const int echoPin2 = 6; // Echo pin of sensor 2
const int trigPin2 = 7; // Trigger pin of sensor 2
const int PUL_PIN = 2; // PUL- pin of microstep driver
const int DIR_PIN = 3; // DIR- pin of microstep driver
const int stepDelay = 50; // Delay between steps (in ms)
const int detectionDistance = 45; // Distance in cm for detection (1.5 feet = 45.72 cm)
const unsigned long sensorTriggerTime = 3000; // Time to detect object continuously (3 seconds)
const unsigned long motorMoveTime = 11000; // Time to move the motor in milliseconds (11 seconds)
// Variables for motor control and state
bool motorMoving = false;
bool direction1 = true; // true for direction 1, false for direction 2
unsigned long motorStartTime = 0;
unsigned long sensorStartTime = 0;
unsigned long lastPrintTime = 0; // Variable to track last print time
// Distance variables
int distance1 = 0;
int distance2 = 0;
void setup() {
// Initialize serial communication for debugging
Serial.begin(9600);
// Initialize pin modes
pinMode(trigPin1, OUTPUT);
pinMode(echoPin1, INPUT);
pinMode(trigPin2, OUTPUT);
pinMode(echoPin2, INPUT);
pinMode(PUL_PIN, OUTPUT);
pinMode(DIR_PIN, OUTPUT);
}
void loop() {
// Step 3: Continuously monitor sensors
int objectDetected = checkSensors();
// Print distances and messages once every half second
if (millis() - lastPrintTime > 500) {
Serial.print("Distance 1: ");
Serial.print(distance1);
Serial.print(" cm, Distance 2: ");
Serial.print(distance2);
Serial.println(" cm");
// Update last print time
lastPrintTime = millis();
}
// Step 4: Check for continuous triggering
if (objectDetected > 0 && millis() - sensorStartTime > sensorTriggerTime && !motorMoving) {
// Start motor in direction 1
startMotor(direction1);
}
// Step 6: Post-movement monitoring
if (motorMoving && millis() - motorStartTime > motorMoveTime) {
motorMoving = false;
direction1 = !direction1; // Toggle direction after completion of movement
Serial.println("Motor stopped after 11 seconds.");
sensorStartTime = millis(); // Start monitoring sensors again
}
// Step 7: Motor movement in direction 2 with immediate reversal on detection
if (motorMoving && !direction1) {
if (objectDetected > 0) {
// Immediate reversal
stopMotor();
delay(100); // Small delay for stability
startMotor(true); // Start moving back in direction 1
}
}
}
// Function to check sensors and return 1 if object detected, 0 if not
int checkSensors() {
long duration1, duration2;
int distance1_temp, distance2_temp; // Declare temporary distance variables
// Sensor 1
digitalWrite(trigPin1, LOW);
delayMicroseconds(2);
digitalWrite(trigPin1, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin1, LOW);
duration1 = pulseIn(echoPin1, HIGH);
distance1_temp = duration1 * 0.034 / 2;
// Sensor 2
digitalWrite(trigPin2, LOW);
delayMicroseconds(2);
digitalWrite(trigPin2, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin2, LOW);
duration2 = pulseIn(echoPin2, HIGH);
distance2_temp = duration2 * 0.034 / 2;
// Assign values to distance variables after validity checks
if (distance1_temp >= 0 && distance1_temp <= 400) {
distance1 = distance1_temp;
}
if (distance2_temp >= 0 && distance2_temp <= 400) {
distance2 = distance2_temp;
}
// Check if object detected within detectionDistance cm
if (distance1 <= detectionDistance || distance2 <= detectionDistance) {
return 1;
} else {
return 0;
}
}
// Function to start the motor
void startMotor(bool dir) {
digitalWrite(DIR_PIN, dir ? HIGH : LOW); // Set direction
digitalWrite(PUL_PIN, HIGH); // Step pulse
delay(stepDelay);
digitalWrite(PUL_PIN, LOW);
delay(stepDelay);
motorMoving = true;
motorStartTime = millis(); // Record start time
Serial.println(dir ? "Motor started in direction 1." : "Motor started in direction 2.");
}
// Function to stop the motor
void stopMotor() {
digitalWrite(PUL_PIN, LOW);
motorMoving = false;
}
Initial issues:
- Motor isn't moving or is pulsing although a 50 ms stepdelay has worked before
