forked from KolibriOS/kolibrios
366 lines
8.8 KiB
Plaintext
366 lines
8.8 KiB
Plaintext
(*
|
||
Пример для STM32L152C-DISCO
|
||
|
||
Работа со встроенным ЖКИ.
|
||
|
||
использовано:
|
||
https://habr.com/ru/post/173709/
|
||
*)
|
||
|
||
MODULE LCD;
|
||
|
||
IMPORT SYSTEM;
|
||
|
||
|
||
CONST
|
||
|
||
GPIOA = 40020000H;
|
||
GPIOAMODER = GPIOA;
|
||
GPIOAOTYPER = GPIOA + 04H;
|
||
GPIOAOSPEEDR = GPIOA + 08H;
|
||
GPIOAPUPDR = GPIOA + 0CH;
|
||
GPIOAIDR = GPIOA + 10H;
|
||
GPIOAODR = GPIOA + 14H;
|
||
GPIOABSRR = GPIOA + 18H;
|
||
GPIOALCKR = GPIOA + 1CH;
|
||
GPIOAAFRL = GPIOA + 20H;
|
||
GPIOAAFRH = GPIOA + 24H;
|
||
GPIOABRR = GPIOA + 28H;
|
||
|
||
|
||
GPIOB = 40020400H;
|
||
GPIOBMODER = GPIOB;
|
||
GPIOBOTYPER = GPIOB + 04H;
|
||
GPIOBOSPEEDR = GPIOB + 08H;
|
||
GPIOBPUPDR = GPIOB + 0CH;
|
||
GPIOBIDR = GPIOB + 10H;
|
||
GPIOBODR = GPIOB + 14H;
|
||
GPIOBBSRR = GPIOB + 18H;
|
||
GPIOBLCKR = GPIOB + 1CH;
|
||
GPIOBAFRL = GPIOB + 20H;
|
||
GPIOBAFRH = GPIOB + 24H;
|
||
GPIOBBRR = GPIOB + 28H;
|
||
|
||
|
||
GPIOC = 40020800H;
|
||
GPIOCMODER = GPIOC;
|
||
GPIOCOTYPER = GPIOC + 04H;
|
||
GPIOCOSPEEDR = GPIOC + 08H;
|
||
GPIOCPUPDR = GPIOC + 0CH;
|
||
GPIOCIDR = GPIOC + 10H;
|
||
GPIOCODR = GPIOC + 14H;
|
||
GPIOCBSRR = GPIOC + 18H;
|
||
GPIOCLCKR = GPIOC + 1CH;
|
||
GPIOCAFRL = GPIOC + 20H;
|
||
GPIOCAFRH = GPIOC + 24H;
|
||
GPIOCBRR = GPIOC + 28H;
|
||
|
||
|
||
RCC = 40023800H;
|
||
RCC_CR = RCC;
|
||
RCC_AHBENR = RCC + 1CH;
|
||
RCC_APB2ENR = RCC + 20H;
|
||
RCC_APB1ENR = RCC + 24H;
|
||
RCC_CSR = RCC + 34H;
|
||
|
||
|
||
PWR = 40007000H;
|
||
PWR_CR = PWR;
|
||
|
||
|
||
LCD = 40002400H;
|
||
LCD_CR = LCD;
|
||
LCD_FCR = LCD + 04H;
|
||
LCD_SR = LCD + 08H;
|
||
LCD_RAM = LCD + 14H;
|
||
|
||
|
||
AFM = 2;
|
||
|
||
AF11 = 11;
|
||
|
||
PinsA = {1..3, 8..10, 15};
|
||
PinsB = {3..5, 8..15};
|
||
PinsC = {0..3, 6..11};
|
||
|
||
A = 0; H = 7;
|
||
B = 1; J = 8;
|
||
C = 2; K = 9;
|
||
D = 3; M = 10;
|
||
E = 4; N = 11;
|
||
F = 5; P = 12;
|
||
G = 6; Q = 13;
|
||
|
||
DP = 14; COLON = 15; BAR = 16;
|
||
|
||
|
||
VAR
|
||
display: ARRAY 6, 17 OF INTEGER;
|
||
|
||
digits: ARRAY 10 OF SET;
|
||
|
||
|
||
PROCEDURE SetPinsMode (reg: INTEGER; pins: SET; mode: INTEGER);
|
||
VAR
|
||
x: SET;
|
||
pin: INTEGER;
|
||
|
||
BEGIN
|
||
mode := mode MOD 4;
|
||
SYSTEM.GET(reg, x);
|
||
FOR pin := 0 TO 30 BY 2 DO
|
||
IF (pin DIV 2) IN pins THEN
|
||
x := x - {pin, pin + 1} + BITS(LSL(mode, pin))
|
||
END
|
||
END;
|
||
SYSTEM.PUT(reg, x)
|
||
END SetPinsMode;
|
||
|
||
|
||
PROCEDURE SRBits (adr: INTEGER; setbits, resetbits: SET);
|
||
VAR
|
||
x: SET;
|
||
|
||
BEGIN
|
||
SYSTEM.GET(adr, x);
|
||
SYSTEM.PUT(adr, x - resetbits + setbits)
|
||
END SRBits;
|
||
|
||
|
||
PROCEDURE SetBits (adr: INTEGER; bits: SET);
|
||
VAR
|
||
x: SET;
|
||
|
||
BEGIN
|
||
SYSTEM.GET(adr, x);
|
||
SYSTEM.PUT(adr, x + bits)
|
||
END SetBits;
|
||
|
||
|
||
PROCEDURE ResetBits (adr: INTEGER; bits: SET);
|
||
VAR
|
||
x: SET;
|
||
|
||
BEGIN
|
||
SYSTEM.GET(adr, x);
|
||
SYSTEM.PUT(adr, x - bits)
|
||
END ResetBits;
|
||
|
||
|
||
PROCEDURE TestBits (adr: INTEGER; bits: SET): BOOLEAN;
|
||
VAR
|
||
x: SET;
|
||
|
||
BEGIN
|
||
SYSTEM.GET(adr, x);
|
||
RETURN x * bits = bits
|
||
END TestBits;
|
||
|
||
|
||
PROCEDURE Init;
|
||
VAR
|
||
i, j: INTEGER;
|
||
seg: ARRAY 30 OF INTEGER;
|
||
|
||
BEGIN
|
||
FOR i := 0 TO 29 DO
|
||
seg[i] := i
|
||
END;
|
||
|
||
FOR i := 3 TO 11 DO
|
||
seg[i] := i + 4
|
||
END;
|
||
|
||
seg[18] := 17;
|
||
seg[19] := 16;
|
||
|
||
FOR i := 20 TO 23 DO
|
||
seg[i] := i - 2
|
||
END;
|
||
|
||
j := 0;
|
||
FOR i := 0 TO 5 DO
|
||
display[i, A] := 256 + seg[28 - j];
|
||
display[i, B] := 0 + seg[28 - j];
|
||
display[i, C] := 256 + seg[j + 1];
|
||
display[i, D] := 256 + seg[j];
|
||
display[i, E] := 0 + seg[j];
|
||
display[i, F] := 256 + seg[29 - j];
|
||
display[i, G] := 0 + seg[29 - j];
|
||
display[i, H] := 768 + seg[29 - j];
|
||
display[i, J] := 768 + seg[28 - j];
|
||
display[i, K] := 512 + seg[28 - j];
|
||
display[i, M] := 0 + seg[j + 1];
|
||
display[i, N] := 768 + seg[j];
|
||
display[i, P] := 512 + seg[j];
|
||
display[i, Q] := 512 + seg[29 - j];
|
||
INC(j, 2)
|
||
END;
|
||
|
||
display[0, DP] := 768 + 1;
|
||
display[1, DP] := 768 + 7;
|
||
display[2, DP] := 768 + 9;
|
||
display[3, DP] := 768 + 11;
|
||
|
||
display[0, COLON] := 512 + 1;
|
||
display[1, COLON] := 512 + 7;
|
||
display[2, COLON] := 512 + 9;
|
||
display[3, COLON] := 512 + 11;
|
||
|
||
display[0, BAR] := 768 + 15;
|
||
display[1, BAR] := 512 + 15;
|
||
display[2, BAR] := 768 + 13;
|
||
display[3, BAR] := 512 + 13;
|
||
|
||
digits[0] := {A, B, C, D, E, F};
|
||
digits[1] := {B, C};
|
||
digits[2] := {A, B, M, G, E, D};
|
||
digits[3] := {A, B, M, G, C, D};
|
||
digits[4] := {F, G, M, B, C};
|
||
digits[5] := {A, F, G, M, C, D};
|
||
digits[6] := {A, F, G, M, C, D, E};
|
||
digits[7] := {F, A, B, C};
|
||
digits[8] := {A, B, C, D, E, F, G, M};
|
||
digits[9] := {A, B, C, D, F, G, M};
|
||
END Init;
|
||
|
||
|
||
PROCEDURE ResetSeg (seg: INTEGER);
|
||
BEGIN
|
||
ResetBits(LCD_RAM + (seg DIV 256) * 2 * 4, {seg MOD 256})
|
||
END ResetSeg;
|
||
|
||
|
||
PROCEDURE SetSeg (seg: INTEGER);
|
||
BEGIN
|
||
SetBits(LCD_RAM + (seg DIV 256) * 2 * 4, {seg MOD 256})
|
||
END SetSeg;
|
||
|
||
|
||
PROCEDURE Digit (pos, dgt: INTEGER);
|
||
VAR
|
||
s: SET;
|
||
i: INTEGER;
|
||
|
||
BEGIN
|
||
s := digits[dgt];
|
||
FOR i := 0 TO 13 DO
|
||
IF i IN s THEN
|
||
SetSeg(display[pos, i])
|
||
ELSE
|
||
ResetSeg(display[pos, i])
|
||
END
|
||
END
|
||
END Digit;
|
||
|
||
|
||
PROCEDURE WhileBits (adr: INTEGER; bits: SET);
|
||
BEGIN
|
||
WHILE TestBits(adr, bits) DO END
|
||
END WhileBits;
|
||
|
||
|
||
PROCEDURE UntilBits (adr: INTEGER; bits: SET);
|
||
BEGIN
|
||
REPEAT UNTIL TestBits(adr, bits)
|
||
END UntilBits;
|
||
|
||
|
||
PROCEDURE main;
|
||
VAR
|
||
i: INTEGER;
|
||
|
||
BEGIN
|
||
Init;
|
||
|
||
(* подключить GPIOA, GPIOB, GPIOC *)
|
||
SetBits(RCC_AHBENR, {0, 1, 2});
|
||
|
||
(* настроить на режим альтернативной функции *)
|
||
SetPinsMode(GPIOAMODER, PinsA, AFM);
|
||
|
||
(* 400 кГц *)
|
||
SetPinsMode(GPIOAOSPEEDR, PinsA, 0);
|
||
|
||
(* без подтягивающих резисторов *)
|
||
SetPinsMode(GPIOAPUPDR, PinsA, 0);
|
||
|
||
(* режим push-pull *)
|
||
ResetBits(GPIOAOTYPER, PinsA);
|
||
|
||
(* альтернативная функция AF11 = 0BH *)
|
||
SYSTEM.PUT(GPIOAAFRL, 0BBB0H);
|
||
SYSTEM.PUT(GPIOAAFRH, 0B0000BBBH);
|
||
|
||
(* аналогично для GPIOB *)
|
||
SetPinsMode(GPIOBMODER, PinsB, AFM);
|
||
SetPinsMode(GPIOBOSPEEDR, PinsB, 0);
|
||
SetPinsMode(GPIOBPUPDR, PinsB, 0);
|
||
ResetBits(GPIOBOTYPER, PinsB);
|
||
SYSTEM.PUT(GPIOBAFRL, 000BBB000H);
|
||
SYSTEM.PUT(GPIOBAFRH, 0BBBBBBBBH);
|
||
|
||
(* аналогично для GPIOC *)
|
||
SetPinsMode(GPIOCMODER, PinsC, AFM);
|
||
SetPinsMode(GPIOCOSPEEDR, PinsC, 0);
|
||
SetPinsMode(GPIOCPUPDR, PinsC, 0);
|
||
ResetBits(GPIOCOTYPER, PinsC);
|
||
SYSTEM.PUT(GPIOCAFRL, 0BB00BBBBH);
|
||
SYSTEM.PUT(GPIOCAFRH, 00000BBBBH);
|
||
|
||
(* подключить контроллер ЖКИ *)
|
||
SetBits(RCC_APB1ENR, {9, 28}); (* LCDEN = {9}; PWREN = {28} *)
|
||
|
||
(* разрешить запись в регистр RCC_CSR *)
|
||
SetBits(PWR_CR, {8}); (* DBP = {8} *)
|
||
|
||
(* сбросить источник тактирования *)
|
||
SetBits(RCC_CSR, {23}); (* RTCRST = {23} *)
|
||
|
||
(* выбрать новый источник *)
|
||
ResetBits(RCC_CSR, {23}); (* RTCRST = {23} *)
|
||
|
||
(* включить НЧ генератор *)
|
||
SetBits(RCC_CSR, {8}); (* LSEON = {8} *)
|
||
|
||
(* ждать готовность НЧ генератора *)
|
||
UntilBits(RCC_CSR, {9}); (* LSERDY = {9} *)
|
||
|
||
(* выбрать НЧ генератор как источник тактирования *)
|
||
SRBits(RCC_CSR, {16}, {17}); (* RCC_CSR[17:16] := 01b *)
|
||
|
||
(* настроить контроллер ЖКИ *)
|
||
SRBits(LCD_CR, {2, 3, 6, 7}, {4, 5}); (* MUX_SEG = {7}; BIAS1 = {6}; BIAS0 = {5}; DUTY2 = {4}; DUTY1 = {3}; DUTY0 = {2} *)
|
||
|
||
(* Установить значения коэффициентов деления частоты тактового сигнала LCDCLK *)
|
||
SRBits(LCD_FCR, {11, 18, 24}, {10..12, 18..25}); (* LCD_FCR[12:10] := 010b; LCD_FCR[21:18] := 0001b; LCD_FCR[25:22] := 0100b *)
|
||
|
||
(* ждать синхронизацию регистра LCD_FCR *)
|
||
UntilBits(LCD_SR, {5}); (* FCRSF = {5} *)
|
||
|
||
(* выбрать внутренний источник напряжения для ЖКИ и разрешить его работу *)
|
||
SRBits(LCD_CR, {0}, {1}); (* LCD_CR_VSEL = {1}; LCD_CR_LCDEN = {0} *)
|
||
|
||
(* ждать готовность контроллера ЖКИ *)
|
||
UntilBits(LCD_SR, {0, 4}); (* LCD_SR_RDY = {4}; LCD_SR_ENS = {0} *)
|
||
|
||
(* ждать завершение предыдущей записи *)
|
||
WhileBits(LCD_SR, {2}); (* LCD_SR_UDR = {2} *)
|
||
|
||
(* начать запись *)
|
||
FOR i := 0 TO 5 DO
|
||
Digit(i, i + 1) (* 123456 *)
|
||
END;
|
||
|
||
SetSeg(display[1, DP]); (* 12.3456 *)
|
||
SetSeg(display[3, COLON]); (* 12.34:56 *)
|
||
SetSeg(display[0, BAR]); (* 12.34:56_ *)
|
||
|
||
(* завершить запись *)
|
||
SetBits(LCD_SR, {2}) (* LCD_SR_UDR = {2} *)
|
||
END main;
|
||
|
||
|
||
BEGIN
|
||
main
|
||
END LCD. |