|
@@ -5,11 +5,33 @@
|
|
|
// Adafruit_PWMServoDriver Adafruit_PWMServoDriver_0X40 = Adafruit_PWMServoDriver(0x41);
|
|
// Adafruit_PWMServoDriver Adafruit_PWMServoDriver_0X40 = Adafruit_PWMServoDriver(0x41);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
+ //disabled
|
|
|
|
|
+
|
|
|
|
|
+
|
|
|
|
|
+
|
|
|
|
|
+
|
|
|
|
|
+ void Adafruit_PWMServoDriver__add(Adafruit_PWMServoDriver_T* Adafruit_PWMServoDriver_A,
|
|
|
|
|
+ Adafruit_PWMServoDriver_ATTR_ARRAY_T &Adafruit_PWMServoDriver_ATTR_ARRAY_A) {
|
|
|
|
|
+ int i;
|
|
|
|
|
+ //int *ptrNumber;
|
|
|
|
|
+ for(i=1;i<=ARDUINO_ARRAY_INDEX_LIMIT_PORTS ; i++) {
|
|
|
|
|
+ if(not(Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == 0 )) {
|
|
|
|
|
+ //Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A = I2C_ADDRESS_A;
|
|
|
|
|
+ //Adafruit_PWMServoDriver _class_cntr = Adafruit_PWMServoDriver(I2C_ADDRESS_A) ;
|
|
|
|
|
+ Adafruit_PWMServoDriver_A[i].Adafruit_PWMServoDriver_V = Adafruit_PWMServoDriver(Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A);
|
|
|
|
|
+ }
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+
|
|
|
|
|
+
|
|
|
|
|
+
|
|
|
|
|
|
|
|
int Adafruit_PWMServoDriver_init_all(Adafruit_PWMServoDriver_T* Adafruit_PWMServoDriver_A) {
|
|
int Adafruit_PWMServoDriver_init_all(Adafruit_PWMServoDriver_T* Adafruit_PWMServoDriver_A) {
|
|
|
int i;
|
|
int i;
|
|
|
//int *ptrNumber;
|
|
//int *ptrNumber;
|
|
|
- for(i=1;i<=ARDUINO_ARRAY_INDEX_LIMIT_PORTS ; i++) {
|
|
|
|
|
|
|
+ for(i=1;i<=ARDUINO_ARRAY_INDEX_LIMIT_PORTS_I2C ; i++) {
|
|
|
if(not(Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == 0 )) {
|
|
if(not(Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == 0 )) {
|
|
|
//Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A = I2C_ADDRESS_A;
|
|
//Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A = I2C_ADDRESS_A;
|
|
|
//Adafruit_PWMServoDriver _class_cntr = Adafruit_PWMServoDriver(I2C_ADDRESS_A) ;
|
|
//Adafruit_PWMServoDriver _class_cntr = Adafruit_PWMServoDriver(I2C_ADDRESS_A) ;
|
|
@@ -23,7 +45,7 @@
|
|
|
|
|
|
|
|
int Adafruit_PWMServoDriver_begin_all(Adafruit_PWMServoDriver_T* Adafruit_PWMServoDriver_A) {
|
|
int Adafruit_PWMServoDriver_begin_all(Adafruit_PWMServoDriver_T* Adafruit_PWMServoDriver_A) {
|
|
|
int i;
|
|
int i;
|
|
|
- for(i=1;i<=ARDUINO_ARRAY_INDEX_LIMIT_PORTS ; i++) {
|
|
|
|
|
|
|
+ for(i=1;i<=ARDUINO_ARRAY_INDEX_LIMIT_PORTS_I2C ; i++) {
|
|
|
if(not(Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == 0)) {
|
|
if(not(Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == 0)) {
|
|
|
Adafruit_PWMServoDriver_A[i].Adafruit_PWMServoDriver_V.begin();
|
|
Adafruit_PWMServoDriver_A[i].Adafruit_PWMServoDriver_V.begin();
|
|
|
Serial.print("#577 setPWM begin ["); Serial.print(i); Serial.println("]");
|
|
Serial.print("#577 setPWM begin ["); Serial.print(i); Serial.println("]");
|
|
@@ -39,7 +61,7 @@
|
|
|
I2C_ADDRESS_T I2C_ADDRESS_A ) {
|
|
I2C_ADDRESS_T I2C_ADDRESS_A ) {
|
|
|
int i;
|
|
int i;
|
|
|
//int *ptrNumber;
|
|
//int *ptrNumber;
|
|
|
- for(i=1;i<=ARDUINO_ARRAY_INDEX_LIMIT_PORTS ; i++) {
|
|
|
|
|
|
|
+ for(i=1;i<=ARDUINO_ARRAY_INDEX_LIMIT_PORTS_I2C ; i++) {
|
|
|
if(Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == 0 || Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == I2C_ADDRESS_A) {
|
|
if(Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == 0 || Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == I2C_ADDRESS_A) {
|
|
|
Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A = I2C_ADDRESS_A;
|
|
Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A = I2C_ADDRESS_A;
|
|
|
//Adafruit_PWMServoDriver _class_cntr = Adafruit_PWMServoDriver(I2C_ADDRESS_A) ;
|
|
//Adafruit_PWMServoDriver _class_cntr = Adafruit_PWMServoDriver(I2C_ADDRESS_A) ;
|
|
@@ -53,7 +75,7 @@
|
|
|
|
|
|
|
|
int Adafruit_PWMServoDriver_begin(Adafruit_PWMServoDriver_T* Adafruit_PWMServoDriver_A,I2C_ADDRESS_T I2C_ADDRESS_A) {
|
|
int Adafruit_PWMServoDriver_begin(Adafruit_PWMServoDriver_T* Adafruit_PWMServoDriver_A,I2C_ADDRESS_T I2C_ADDRESS_A) {
|
|
|
int i;
|
|
int i;
|
|
|
- for(i=1;i<=ARDUINO_ARRAY_INDEX_LIMIT_PORTS ; i++) {
|
|
|
|
|
|
|
+ for(i=1;i<=ARDUINO_ARRAY_INDEX_LIMIT_PORTS_I2C ; i++) {
|
|
|
if(Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == I2C_ADDRESS_A) {
|
|
if(Adafruit_PWMServoDriver_A[i].I2C_ADDRESS_A == I2C_ADDRESS_A) {
|
|
|
Adafruit_PWMServoDriver_A[i].Adafruit_PWMServoDriver_V.begin();
|
|
Adafruit_PWMServoDriver_A[i].Adafruit_PWMServoDriver_V.begin();
|
|
|
Serial.print("#577 setPWM begin ["); Serial.print(i); Serial.println("]");
|
|
Serial.print("#577 setPWM begin ["); Serial.print(i); Serial.println("]");
|
|
@@ -91,7 +113,7 @@ ARDUINO_ARRAY_PRIMARY_KET_T Adafruit_PWMServoDriver__get_PRIMARY_KET_T(Adafruit_
|
|
|
break;
|
|
break;
|
|
|
}
|
|
}
|
|
|
}
|
|
}
|
|
|
- //return 1;
|
|
|
|
|
|
|
+ return 0;
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
@@ -114,7 +136,7 @@ void Adafruit_PWMServoDriver__print_status(Adafruit_PWMServoDriver_T* Adafruit_P
|
|
|
|
|
|
|
|
int Adafruit_PWMServoDriver_init_I = Adafruit_PWMServoDriver_init_all(Adafruit_PWMServoDriver_A);
|
|
int Adafruit_PWMServoDriver_init_I = Adafruit_PWMServoDriver_init_all(Adafruit_PWMServoDriver_A);
|
|
|
|
|
|
|
|
-
|
|
|
|
|
|
|
+
|
|
|
|
|
|
|
|
/*
|
|
/*
|
|
|
Adafruit_PWMServoDriver Adafruit_PWMServoDriver_F(I2C_ADDRESS_T I2C_ADDRESS_A) {
|
|
Adafruit_PWMServoDriver Adafruit_PWMServoDriver_F(I2C_ADDRESS_T I2C_ADDRESS_A) {
|