麻烦大佬帮我看看按键控制led的亮灭啊(置0为亮，也就是共阳

麻烦大佬帮我看看按键控制led的亮灭啊(置0为亮，也就是共阳极)，我想实现按key1可以亮绿色，按key2可以亮红色。如果亮的是绿色按key1会灭、按key2会从绿变红，相反的是红色也一样。
但是目前他们在绿变红和红变绿的过程出现问题，会变成黄色，就如图三(绿和黄可能不太明显，图二是绿)，除非关掉另一个颜色，不然是不会直接切换的，但是我觉得我的程序没有错(如图一)，if中嵌套一个if，外面的if判断按键是否按下(有松手检测)，内部的if是对另外一个灯是否亮着的判断，如果是亮着那么就先关掉再将张打开的灯打开
切换的函数我用的是异或逻辑(如图五)