[bls0620]

Here is a code that I made for our team. I used a flag to prevent the switch from switching back and forth. FYI, you might have to change things a bit(even though there's not many stuff) for your project.