IMU driven head mechanism prototype

I’ve got some crude code working; reading a MPU6050 IMU then mapping the pitch and roll values to the servos outputs. Obviously, as there's two opposing servos per axis, one has to turn clockwise and the other counterclockwise in order move the platform. I will need to re-work the mechanism for the actual robot and smooth the code but I'm happy the concept works.