In main.c move waitVBlank(); in line 572 up under SCClose(); 554. Also I think that the function Control_Sub(); should not be executed between SCClose and waitVBlank. There are other places in your code this happens.

The color code you need is ff0ff I believe.

Hope this helps. I'll look through the code again later.