WIP: Optimizing/redefining main loop(angle value calculating)
Stable Angle processing in place. TODO: impl I2C and UART in pooling or interrupt mode for better performance