Ja, das Programm sollte mit den genannten Änderungen auf der M32 laufen.
Bei deinem Code sehe ich aber z.B. nicht die Initialisierung der ControlLib im Main: initRP6Control();