Пишите на ST, если надо, можно конвертировать в LD и посмотреть.
А вопросы задавайте конкретные на куске кода, разбираться в программе целиком никто не будет.