LCD HD44780 an STM32F

Hallo,

ich habe ein Problem mit meinem HD44780 LCD Display an einem STM32F10x 
(72MHz).

Ich habe nachfolgenden Code im Einsatz, doch das angehängte Bild stellt 
dar was dabei herauskommt.

Das Grundgerüst des Codes habe ich aus dem Internet und dann an Hand des 
Datenblatts eigentlich so angepasst, dass alles im 4-Bit-Mode laufen 
müsste.

main.c:

int main(void)
{

  toLine2(); // Schreibe in die 2. Zeile des Display

  while(1)
  {
      printChar(0x7F); // Schreibe ständig das Zeichen "<-"
  }
}

lcd.c:

#include "stm32f10x.h"

#define LCD_Port GPIOC
#define RS GPIO_Pin_1
#define EN GPIO_Pin_3
#define D4 GPIO_Pin_4
#define D5 GPIO_Pin_5
#define D6 GPIO_Pin_6
#define D7 GPIO_Pin_7

void lcdInit(void);
void sendCMD(uint8_t c);
void printChar(uint8_t c);
void printString(uint8_t *s);
void clearLCD(void);
void toLine1(void);
void toLine2(void);
void Delay(uint32_t nCount);
void strobeEN(void);
void upNib(uint8_t c);
void downNib(uint8_t c);

void lcdInit(void) {

   GPIO_InitTypeDef GPIO_InitStructure;

   RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC, ENABLE);

    //Init GPIOs
    GPIO_InitStructure.GPIO_Pin   = EN | RS | D4 | D5 | D6 | D7;
    GPIO_ResetBits(LCD_Port, EN | RS | D4 | D5 | D6 | D7);
    GPIO_InitStructure.GPIO_Mode  = GPIO_Mode_Out_PP;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_10MHz;
    GPIO_Init(LCD_Port, &GPIO_InitStructure);
    GPIO_ResetBits(LCD_Port, EN | RS | D4 | D5 | D6 | D7);

    Delay(0xffff); // Nach Reset 5ms Zeitschleife

    sendCMD(0x30);

    sendCMD(0x30);

    sendCMD(0x30);

    sendCMD(0x20); // In 4-Bit-Mode wechseln, noch im 8-Bit-Mode

    Delay(0x3FFFC); // 20ms Zeitschleife

    sendCMD(0x28); // Function Set, 4-Bit, 2-zeilig, 5x7 Dot Display

    sendCMD(0x0f); // Display an, Cursor anzeigen, Cursorstelle blinkt

    sendCMD(0x01);          // Display löschen

    Delay(0xffff);          // 5ms Zeitschleife

}

void strobeEN(void) {
  Delay(0xffff);
  GPIO_SetBits(LCD_Port, EN);
  Delay(0xffff);
  GPIO_ResetBits(LCD_Port, EN);
}

void upNib(uint8_t c) {
  if(c & 0x80)
    GPIO_SetBits(LCD_Port, D7);
  else
    GPIO_ResetBits(LCD_Port, D7);
  if(c & 0x40)
    GPIO_SetBits(LCD_Port, D6);
  else
    GPIO_ResetBits(LCD_Port, D6);
  if(c & 0x20)
    GPIO_SetBits(LCD_Port, D5);
  else
    GPIO_ResetBits(LCD_Port, D5);
  if(c & 0x10)
    GPIO_SetBits(LCD_Port, D4);
  else
    GPIO_ResetBits(LCD_Port, D4);
}

void downNib(uint8_t c) {
  if(c & 0x8)
    GPIO_SetBits(LCD_Port, D7);
  else
    GPIO_ResetBits(LCD_Port, D7);
  if(c & 0x4)
    GPIO_SetBits(LCD_Port, D6);
  else
    GPIO_ResetBits(LCD_Port, D6);
  if(c & 0x2)
    GPIO_SetBits(LCD_Port, D5);
  else
    GPIO_ResetBits(LCD_Port, D5);
  if(c & 0x1)
    GPIO_SetBits(LCD_Port, D4);
  else
    GPIO_ResetBits(LCD_Port, D4);
}

// Befehl senden
void sendCMD(uint8_t c) {
  GPIO_ResetBits(LCD_Port, RS); // RS 0=Byte als Befehl interpretieren
  upNib(c); // Obere 4 Bits senden
  strobeEN(); // Enable Leitung
  downNib(c); // Untere 4 Bits senden
  strobeEN(); // Enable Leitung
}

// Byte auf Display ausgeben
void printChar(uint8_t c) {
// Überprüfen ob "c" ein gültiges Zeichen ist (Zeichensatztabelle)
  if(((c>=0x20)&&(c<=0x7F)) || ((c>=0xA0)&&(c<=0xFF))) {
    GPIO_SetBits(LCD_Port, RS); // RS 1=Byte auf Display ausgeben
    upNib(c); // Obere 4 Bits senden
    strobeEN(); // Enable Leitung
    downNib(c); // Untere 4 Bits senden
    strobeEN(); // Enable Leitung
    GPIO_ResetBits(LCD_Port, RS); // RS 0=Byte als Befehl interp.
  }
}

void printString(uint8_t *s) {
  uint8_t i=0;

  while(s[i] != '\0') {
    printChar(s[i]);
    i++;
  }
}

// Display löschen
void clearLCD(void) {
  sendCMD(0x01);
}

// In 1. Zeile bewegen
void toLine1(void) {
  sendCMD(0x00);
}

// In 2. Zeile bewegen
void toLine2(void) {
  sendCMD(0x40);
}

// Zeitschleife
void Delay(uint32_t nCount)
{
  for(; nCount != 0; nCount--);
}

Stimmt die Initialisierung soweit?
Mein Kabellänge zum Display beträgt ca. 12cm ... laut Datenblatt treten 
Probleme wenn dann ab ca. 20cm auf ...

Wäre über Hilfe sehr dankbar! :)