Suggestion to fix getMode

[formigarafa]

I could not test your code directly because I am working with a different Serial Implementation but I was using this code as reference and I believe it is just fair to share how I got it to work for me. I hope it can be useful to someone.