import os, sys, io
import M5
from M5 import *
import time

accel = None
gyro = None


def setup():
  global accel, gyro

  M5.begin()


def loop():
  global accel, gyro
  M5.update()
  acc_x, acc_y, acc_z = Imu.getAccel()
  gyro_x, gyro_y, gyro_z = Imu.getGyro()
  print(f'accel: {acc_x}x, {acc_y}y, {acc_z}z')
  print(f'gyro: {gyro_x}x, {gyro_y}y, {gyro_z}z')
  time.sleep(1)


if __name__ == '__main__':
  try:
    setup()
    while True:
      loop()
  except (Exception, KeyboardInterrupt) as e:
    try:
      from utility import print_error_msg
      print_error_msg(e)
    except ImportError:
      print("please update to latest firmware")