[Arduino] OLEDで「在室」表示(2)

OLEDで「在室」表示(1)で、ちょっと残念な在室表示になりました。スクロールも挙動がおかしいです。
そこで、まずは、改良版です。

「在」、「室」、「不」の文字を48×48 2色のbitmap形式で保存し、コンバーターで変換しておきます。格好悪いですが、とりあえず、それぞれ、zai, situ,huとしておきます。

これを、コンパイルして書き込むと、上部にWelcomeと下部に在室が表示されます。

次に、ブレッドボードにタクトスイッチをつけます。
以下のような配線になります。

setupの前に次を書きます。

int SWITCH_PIN = 2;
int mode=0;
int x=0;

setupの中に次を書きます。

pinMode( SWITCH_PIN, INPUT );

loopに次のように書きます。

if( digitalRead( SWITCH_PIN ) == 1 && mode==0) {
mode=1;
delay(1000);
}
if( digitalRead( SWITCH_PIN ) == 1 && mode==1) {
mode=0;
delay(1000);
}
if(x<-128) {x=128;}
if (mode==0) {
不在の命令
}
if (mode==1) {
在室の命令}
}