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.