Wenn Du in C schreibst, dann hab ich Dir 'nen Code für, bei dem auch die verwendeten Pins frei zugeordnet werden können