#include <stdio.h>
#include <math.h>
#include "pico/stdlib.h"
#include "hardware/i2c.h"
#include "mpu6050_reader.h"
#include "servo_control.h"
#include "screen_utils.h"
#include "angle_monitor.h"

int main() {
    stdio_init_all();
    display_init();
    mpu6050_setup();
    mpu6050_init();
    servo_init();

    float limit_angle = 40.0;
     
    monitor_angle(limit_angle);

    return 0;
}