Änderung von Port bzw. Pin zuweisungen

[XP M. (xpmodder)]

Hallo.
Ich bräuchte etwas Hilfe bei einem kleinen Problem:
Ich verwende einen Arduino UNO um ein TFT-Display zu steuern. Da der 
Speicherplatz des UNO aber ziemlich knapp wird und ich noch einiges in 
das Programm einfügen möchte, will ich das ganze jetzt auf einem Arduino 
MEGA 2560 fortsetzen. Das Problem ist jetzt, das die Bibliothek die ich 
zur Steuerung des Displays verwende einen Fehler in der Portbelegung des 
MEGA hat.
Ich habe diese Tabelle gefunden die die Pinbelegung des MEGA zeigt und 
habe diese Angaben auch bereits überprüft.
+---------------+-----+-----+-----+-----+-----+-----+-----+-----+
| LCD Data Bit  |  7  |  6  |  5  |  4  |  3  |  2  |  1  |  0  |
+---------------+-----+-----+-----+-----+-----+-----+-----+-----+
| Digital pin # |  7  |  6  |  5  |  4  |  3  |  2  |  9  |  8  |
+---------------+-----+-----+-----+-----+-----+-----+-----+-----+
| MEGA port/pin | PH4 | PH3 | PE3 | PG5 | PE5 | PE4 | PH6 | PH5 |
+---------------+-----+-----+-----+-----+-----+-----+-----+-----+
Das Problem was ich habe ist jetzt die entsprechende zuordnung in der 
Bibliothek.
Folgendes findet sich in der Bibliothek zur belegung des MEGA:

DDRH |= 0x78;
DDRB |= 0xB0;
DDRG |= _BV(5);

// bit 6/7 (PH3 & 4)
// first two bits 0 & 1 (PH5 & 6)
PORTH &= ~(0x78);
PORTH |= ((d&0xC0) >> 3) | ((d&0x3) << 5);

// bits 2 & 3 (PB4 & PB5)
// bit 5 (PB7)
PORTB &= ~(0xB0);
PORTB |= ((d & 0x2C) << 2);

// bit 4  (PG5)
if (d & _BV(4))
  PORTG |= _BV(5);
else
  PORTG &= ~_BV(5);


Hier sind für bit 2 PB4, für bit 3 PB5 und für bit 5 PB7 angegeben, was 
nicht stimmt und somit auch nicht funktionieren kann. Ich kann diesen 
Code zwar relativ gut lesen und verstehen aber ich bin nicht sicher wie 
ich ihn verändern sollte. Das größte Problem ist für mich zu verstehen 
wie das Programm zwischen den bits unterscheidet wenn sie nicht in der 
entsprechenden Reihenfolge angegeben sind.

Ich habe auch schon folgendes versucht:

DDRH |= 0x78;
DDRE |= 0x38;
DDRG |= _BV(5);

// bit 6/7 (PH3 & 4)
// first two bits 0 & 1 (PH5 & 6)
PORTH &= ~(0x78);
PORTH |= ((d&0xC0) >> 3) | ((d&0x3) << 5);

// bits 2 & 3 (PB4 & PB5)
// bit 5 (PB7)
PORTE &= ~(0x38);
PORTE |= ((d & 0xE) << 2);

// bit 4  (PG5)
if (d & _BV(4))
  PORTG |= _BV(5);
else
  PORTG &= ~_BV(5);

Das funktioniert jedenfalls nicht.
Ich hoffe ihr könnt mir helfen.