Edited lights debugging
Added reset gyro statement

Added an if statement to reset the gyro every 5 seconds