four MPU6050 at one ESP32

Hello, i would like to connect four equal MPU6050 Sensors to one ESP32.

I guess I could link two of the Sensors to the pins 21/22 and link the two others to the pins 16/17.
To differ the two sensors at the same pin I can turn AD0 HIGH on one sensor each.

Now I have two sensors with the adress 0x68 and two with 0x69.

At the moment I only use one sensor with with the program linked below.

Can anybody help me to change the program so I can use four sensors?

MPU6050.ino (5.17 KB)

I2C.ino (1.67 KB)

Kalman.h (4.24 KB)