Инициализация LCD WH1602B [stm32f4]

#include <stm32f4xx.h>
#include <stm32f4xx_gpio.h>
#include <stm32f4xx_rcc.h>
 
void gpio_init() {
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD, ENABLE);
 
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOC, ENABLE);
 
GPIO_InitTypeDef init;
GPIO_StructInit(&init);
 
init.GPIO_OType = GPIO_OType_PP;
init.GPIO_Mode = GPIO_Mode_OUT;
 
GPIO_Init(GPIOD,&init);
 
GPIO_Init(GPIOC,&init);
}
 
void delay_ms(uint16_t time)
{
volatile uint32_t i;
 
while (time-- > 0)
{
i = 1000;
while (i-- > 0)
{
}
}
}
 
void lcd_write(u16 cmd) {
GPIO_SetByts(GPIOC,cmd | GPIO_Pin_10);
delay_ms(1000);
GPIO_RisetByts(GPIOC,GPIO_Pin_10);
delay_ms(1000);
}
 
void lcd_init() {
delay_ms(1000);
GPIO_RisetByts(GPIOC,GPIO_Pin_12);
 
lcd_write(0b00110000);
 
lcd_write(0b00110000);
 
lcd_write(0b00001000);
 
lcd_write(0b00000001);
 
lcd_write(0b00000110);
 
GPIO_SetByts(GPIOC,GPIO_Pin_12);
}
 
int main(void)
{
gpio_init();
 
GPIO_SetByts(GPIOD,GPIO_Pin_12 | GPIO_Pin_13 | GPIO_Pin_14 | GPIO_Pin_15);
 
lcd_init();
 
delay_ms(10000);
lcd_write(GPIO_Pin_1 | GPIO_Pin_2 | GPIO_Pin_3);
 
delay_ms(10000);
lcd_write(0b00101000);
 
delay_ms(10000);
lcd_write(0b11111111);
while (1)
{
GPIO_Write(GPIOD,~GPIO_ReadInputData(GPIOD));
delay_ms(10000);
}
 
return 0;
}

void delay_ns(uint32_t ns)
{
uint32_t delayLoops = ((SystemCoreClock/3000000) * ns) / 1000;
 
__asm__ __volatile__
(
"1: \n"
" CBZ %[delayLoops], 2f \n"
" SUB %[delayLoops], %[delayLoops], #1 \n"
" B 1b \n"
"2: \n"
: [delayLoops] "+r"(delayLoops)
);
}

   wh_init();
wh_set_cursor(0,0);
wh_write_str("Hello!");

/*
*    File:   main.c
*    Date:   2011-01-02
*/
 
#include <stm32f4xx.h>
#include <stm32f4xx_gpio.h>
#include <stm32f4xx_rcc.h>
 
#include "wh1602.h"
 
void delay_ns(uint32_t ns){
uint32_t delayLoops = ((SystemCoreClock/3000000) * ns) / 1000;
 
__asm__ __volatile__
(
"1: \n"
" CBZ %[delayLoops], 2f \n"
" SUB %[delayLoops], %[delayLoops], #1 \n"
" B 1b \n"
"2: \n"
: [delayLoops] "+r"(delayLoops)
);
}
 
int main(void){
delay_ns(9999);
wh_init();
wh_set_cursor(0,0);
wh_write_str("Hello!");
while (1){
 
}
 
return 0;
}

void lcd_init(void)//lcd init
{
delay_x(2000);
P1OUT&=~lcd_rs_rw;
P1OUT|=lcd_en;
P2OUT=BIT4|BIT5;
P1OUT&=~lcd_en;
 
P1OUT|=lcd_en;
P2OUT=BIT4|BIT5;
P1OUT&=~lcd_en;
delay_x(1000);
 
P1OUT|=lcd_en;
P2OUT=BIT4|BIT5;
P1OUT&=~lcd_en;
delay_x(lcd_delay);
 
P1OUT|=lcd_en;
P2OUT=BIT4|BIT5|BIT3;//function set
P1OUT&=~lcd_en;
delay_x(lcd_delay);
 
P1OUT|=lcd_en;
P2OUT=BIT3|BIT2|BIT1|BIT0;// set dysplay cursor blinking
P1OUT&=~lcd_en;
delay_x(lcd_delay);
 
P1OUT|=lcd_en;    //clear
P2OUT=BIT0;
P1OUT&=~lcd_en;
delay_x(lcd_delay);
 
P1OUT|=lcd_en;//entry mode set
P2OUT=BIT2|BIT1|BIT0;
P1OUT&=~lcd_en;
delay_x(lcd_delay);
while_bf();
}
 
void while_bf(void)//check lcd busy flag
{
P2DIR=0;
P1OUT|=lcd_rw;
P1OUT&=~lcd_rs;
wbf1:P1OUT|=lcd_en;
if(P2IN&BIT7)
{ P1OUT&=~lcd_en;
goto wbf1;
}
P1OUT&=~lcd_en;
P2OUT=0;
P2DIR=0xff;
}
 
void lcd_clr(void)//clear lcd dysplay
{
P1OUT&=~lcd_rs_rw;
P1OUT|=lcd_en;
P2OUT=BIT0;
P1OUT&=~lcd_en;
while_bf();
}
 
//put charster c to current cursor position on lcd
void lcd_put (char c)
{
P1OUT&=~lcd_rw;
P1OUT|=lcd_rs;
P1OUT|=lcd_en;
P2OUT=c;
P1OUT&=~lcd_en;
while_bf();
}

#include "stm32f4xx.h"
#include "stm32f4xx_gpio.h"
#include "stm32f4xx_rcc.h"
#include "wh1602.h"
#include "main.h"

void delay_ns(uint32_t ns)
{
uint32_t delayLoops = ((SystemCoreClock/3000000) * ns) / 1000;
 
__asm__ __volatile__
(
"1: \n"
" CBZ %[delayLoops], 2f \n"
" SUB %[delayLoops], %[delayLoops], #1 \n"
" B 1b \n"
"2: \n"
: [delayLoops] "+r"(delayLoops)
);
}