[Y]Add DEBUG Macro, Modify to use delay_10ms function

[Y]Add DEBUG Macro, Modify to use delay_10ms function