Today I integrated the new IMU i’m using into the code. (also had some beef with the library)

I edited my code to accomodate for the other IMU I’m using (since i broke the previous one, whoooppss)

After that I quickly tested the measured and filtered data, along with the pid output data.

Next up I’m gonna test my motors and encoders!