Added Debug

Changed the IMU setup and added a config file for debug and other values
later on.