ohne zu wissen wie deine Schaltung aufgebaut ist wird dir wohl kaum jemand sinnvoll weiterhelfen können. Ansonsten nehme ich an dass du einfach die einzelnen Schritte der Reihe nach durchschalten musst. Das ist aber auch nix groß anderes wie dein Lauflicht.
Schau dir mal die entsprechenden Bibliotheken an.