#include <Wire.h>
#define ADDS 0x43

#define PIN1 0x00
#define PIN2 0x01
#define PIN3 0x02
#define PIN4 0x03
#define PIN5 0x04
#define PIN6 0x05
#define PIN7 0x06
#define PIN8 0x07
#define PIN9 0x08
#define PIN10 0x09

#define Servo1 0x30
#define Servo2 0x31
#define Servo3 0x32
#define Servo4 0x33
#define Servo5 0x34
#define Servo6 0x35
#define Servo7 0x36
#define Servo8 0x37

uint16_t Readadc(uint8_t pin) {
  Wire1.beginTransmission(ADDS);
  Wire1.write(0x10 | pin);
  Wire1.endTransmission();
  Wire1.requestFrom(ADDS, 2);
  uint8_t h;
  uint8_t l;
  while (Wire1.available()) {
    h = Wire1.read();
    l = Wire1.read();

  }
  return word(h, l);
}

void ServowriteM(uint8_t pin, uint16_t M) {
  if(M<800){
    M =800;
  }
  if(M>2300){
    M =2300;
  }
  Wire1.beginTransmission(ADDS);
  Wire1.write(pin);
  Wire1.write(highByte(M));
  Wire1.write(lowByte(M));
  Wire1.endTransmission();
}
void setup() {
  Wire1.begin(4,5);
  Wire1.setClock(400000);
  Serial.begin(115200);
  delay(1000);
  //setuppin(PIN1,Amode);

}

unsigned long previousMillis = 0;
void loop() {
  ServowriteM(Servo1,1000);
  delay(1000);
  ServowriteM(Servo1,2000);
  delay(1000);
//    unsigned long currentMillis = millis();
//
//  if (currentMillis - previousMillis >= 1000) {
//    // save the last time you blinked the LED
//    previousMillis = currentMillis;
//    //uint16_t x = Readadc(PIN1);
//
//    //Serial.println(x);
//  }

}