センサのレジスタの参照先間違えてたから直した。
あとfor文のインデント修正