/*
 * Original source: https://github.com/adafruit/Adafruit-PWM-Servo-Driver-Library
 * This is the Arduino code for the PCA9685 16-channel servo controller.
 * Watch the video for details and demo: http://youtu.be/y8X9X10Tn1k
 *  get code and wiring diagram from http://robojax.com/RTJ27
 
 * Watch the video for this code: 
 * 
 * Related Videos:
V5 video of PCA9685 32 Servo with ESP32 with WiFi: https://youtu.be/bvqfv-FrrLM
V4 video of PCA9685 32 Servo with ESP32 (no WiFi): https://youtu.be/JFdXB8Za5Os
V3 video of PCA9685: how to control 32 servo motors: https://youtu.be/6P21wG7N6t4
V2 Video of PCA9685: 3 different ways to control servo motors: https://youtu.be/bal2STaoQ1M
V1 Video introduction to PCA9685 to control 16 servos: https://youtu.be/y8X9X10Tn1k

 * Written by Ahmad Shamshiri for Robojax Video channel: www.Robojax.com
 * Date: December 16, 2017, in Ajax, Ontario, Canada
 * Permission granted to share this code, given that this
 * note is kept with the code.
 * Disclaimer: This code is "AS IS" and for educational purposes only.
 * This code has been downloaded from https://robojax.com
 * 
 */
/*************************************************** 
  This is an example for our Adafruit 16-channel PWM & Servo driver.
  Servo test - this will drive 16 servos, one after the other.

  Pick one up today in the Adafruit shop!
  ------> http://www.adafruit.com/products/815

  These displays use I2C to communicate; 2 pins are required to  
  interface. For Arduino UNOs, that's SCL -> Analog 5, SDA -> Analog 4.

  Adafruit invests time and resources providing this open source code, 
  please support Adafruit and open-source hardware by purchasing 
  products from Adafruit!

  Written by Limor Fried/Ladyada for Adafruit Industries.  
  BSD license, all text above must be included in any redistribution.
 ****************************************************/

#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>

// called this way, it uses the default address 0x40
Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();
// you can also call it with a different address you want
//Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver(0x41);

// Depending on your servo make, the pulse width min and max may vary; you 
// want these to be as small/large as possible without hitting the hard stop
// for max range. You'll have to tweak them as necessary to match the servos you
// have!
#define SERVOMIN  125 // this is the 'minimum' pulse length count (out of 4096)
#define SERVOMAX  575 // this is the 'maximum' pulse length count (out of 4096)

// our servo # counter
uint8_t servonum = 0;

void setup() {
  Serial.begin(9600);
  Serial.println("16 channel Servo test!");

  pwm.begin();
  
  pwm.setPWMFreq(60);  // Analog servos run at ~60 Hz updates

  //yield();
}

// the code inside loop() has been updated by Robojax
void loop() {


  for( int angle =0; angle<181; angle +=20){
    delay(500);
    pwm.setPWM(0, 0, angleToPulse(angle) );
  }

  delay(1000);
 
}

/*
 * angleToPulse(int ang)
 * gets angle in degrees and returns the pulse width.
 * Also prints the value on the serial monitor.
 * Written by Ahmad Shamshiri for Robojax, Robojax.com
 */
int angleToPulse(int ang){
   int pulse = map(ang,0, 180, SERVOMIN,SERVOMAX);// map angle of 0 to 180 to Servo min and Servo max 
   Serial.print("Angle: ");Serial.print(ang);
   Serial.print(" pulse: ");Serial.println(pulse);
   return pulse;
}

/*
 * منبع اصلی: https://github.com/adafruit/Adafruit-PWM-Servo-Driver-Library
 * این شِفر (کود) آردوینو برای کنترلر سروو 16 کاناله PCA9685 است.
 * برای جزئیات و دمو ویدیو را مشاهده کنید: http://youtu.be/y8X9X10Tn1k
 * 
 * نوشته شده توسط احمد نجربی برای کانال ویدیویی روبوجکس: www.Robojax.com
 * تاریخ: 15 دسامبر 2017، در اِجَکس، انتاریو، کانادا
 * اجازه انتشار این شِفر (کود) داده شده است به شرطی که این
 * یادداشت همراه شِفر (کود) باشد.
 * سلب مسئولیت: این شِفر (کود) "به صورت موجود" و فقط برای اهداف آموزشی ارائه شده است.
 * 
 * /
 * /***************************************************
 * این یک مثال برای درایور PWM و سروو 16 کاناله آدافرویت است.
 * آزمایش سروو - این شِفر (کود) 16 سروو را یکی بعد از دیگری راه‌اندازی می‌کند.
 * 
 * امروز یکی را از فروشگاه آدافرویت خریداری کنید!
 * ------> http://www.adafruit.com/products/815
 * 
 * این نمایشگرها از I2C برای ارتباط استفاده می‌کنند؛ برای
 * رابطه نیاز به 2 پایه است. برای آردوینو UNO، SCL -> آنالوگ 5، SDA -> آنالوگ 4 است.
 * 
 * آدافرویت زمان و منابعی را صرف ارائه این شِفر (کود) منبع باز می‌کند،
 * لطفاً با خرید محصولات از آدافرویت از آدافرویت و سخت‌افزار منبع باز حمایت کنید!
 * 
 * نوشته شده توسط لیمور فرید/لیدیادا برای صنایع آدافرویت.
 * مجوز BSD، تمام متن بالا باید در هر توزیع کپی شود.
 */
#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>

 // به این صورت نامیده می‌شود، از آدرس پیش‌فرض 0x40 استفاده می‌کند.
Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();
 // شما همچنین می‌توانید آن را با آدرس متفاوتی که می‌خواهید تماس بگیرید.
 // آدافرات_PWMServoDriver pwm = آدافرات_PWMServoDriver(0x41);

 // بسته به نوع سروو شما، حداقل و حداکثر عرض پالس ممکن است متفاوت باشد; شما
 // می‌خواهم این‌ها تا حد ممکن کوچک/بزرگ باشند بدون اینکه به حد سخت برخورد کنند.
 // برای حداکثر برد. شما باید آنها را به صورت لازم تنظیم کنید تا با سرووهایی که دارید مطابقت داشته باشند.
 // داشته باشید!
#define SERVOMIN  125 // این تعداد 'حداقل' طول پالس است (از ۴۰۹۶)
#define SERVOMAX  575 // این تعداد طول پالس 'حداکثری' است (از ۴۰۹۶)

 // سرور شماره ما
uint8_t servonum = 0;

void setup() {
  Serial.begin(9600);
  Serial.println("16 channel Servo test!");

  pwm.begin();

  pwm.setPWMFreq(60); // سرووهای آنالوگ با به‌روزرسانی‌های تقریباً ۶۰ هرتز کار می‌کنند

 // yield();
}

 // شِفر (کود) داخل loop() توسط Robojax به‌روزرسانی شده است.
void loop() {

    pwm.setPWM(0, 0, 125 );
	delay(500);
    pwm.setPWM(0, 0, 255 );
	delay(500);
    pwm.setPWM(0, 0, 450 );
	delay(500);
    pwm.setPWM(0, 0, 575 );
	delay(500);


}