Updated main working auto code

Moving deadband, gyro weighted history