Ok- dann wissen wir, wie vorzugehen ist- wo genau liegt nun das Problem?
Nen fertigen Code (noch dazu, für ein eher seltenes Board) wird dir hier kaum jemand geben.

Das hier dürfte genau das tun, was du suchst.