Fixed few compiler warnings.

I like warning free compilations whenever possible. It increases used flash size by one byte though.