Change the color detection

Change threshold of the color sensor and resolve one bug regarding color