Added function for parsing angles from mpu6050 sensor