28 lines
742 B
C++
28 lines
742 B
C++
/**********************************************************************
|
|
Product : Freenove 4WD Car for ESP32
|
|
Description : use servo.
|
|
Auther : www.freenove.com
|
|
Modification: 2020/12/18
|
|
**********************************************************************/
|
|
#include "Freenove_4WD_Car_For_ESP32.h"
|
|
|
|
void setup()
|
|
{
|
|
PCA9685_Setup(); //Initializes the chip that controls the motor
|
|
Servo_1_Angle(90);//Set servo 1 Angle
|
|
Servo_2_Angle(90);//Set servo 2 Angle
|
|
delay(1000);
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
// Servo 1 motion path; 90°- 0°- 180°- 90°
|
|
Servo_Sweep(1, 90, 0);
|
|
Servo_Sweep(1, 0, 180);
|
|
Servo_Sweep(1, 180, 90);
|
|
|
|
// Servo 2 motion path; 90°- 150°- 90°
|
|
Servo_Sweep(2, 90, 150);
|
|
Servo_Sweep(2, 150, 90);
|
|
}
|