Skip to main content

Understanding the Project and the Blocks Used

This project includes several interconnected blocks. Below are the main blocks and their functions:

startAll

Ensures the system initializes only once after power-up.


i2c

Controls the I2C communication with the MPU6050 sensor.


mpu6050

Manages and retrieves data from the inertial sensor.


arctanCORDIC (two instances)

Computes the tilt angles on two axes using the CORDIC algorithm.


lowPassFilter (two instances)

Filters the angle signals to smooth out noise and fluctuations.


closeLoop (two instances)

Feedback controllers that compare measured angles with the level reference and generate correction commands.


servo (two instances)

Drives the servo motors according to the control signals.


inverterC and AND2b

Used for logic control of the SDA line during I2C communication.