...müssen die Ports nicht noch als Output konfiguriert werden
Klar müssen sie das. Da ich aber deine Pinbelegung nicht kenne, und es ja eigentlich deine Matrix ist, habe ich dir auch was zum Tippen übriggelassen.