display: $PS1 done. logic usage freundlich ;)

diff --git a/src/display.vhd b/src/display.vhd
index d28e1580566a1c25b88f1fd07291ff0746db7851..e374f7ea960d7ce0c620729e618a3fc079a3f9f8 100644 (file)
--- a/src/display.vhd
+++ b/src/display.vhd
@@ -218,6 +218,27 @@ begin
        -- out
        process(state_int, d_zeile_int, d_spalte_int, d_get_int, command_int,
                command_data_int, d_char)
+               function zeile2char(i : std_logic_vector; stelle : natural) return hbyte is
+                       subtype zeilnum is string(1 to 2);
+                       type zeilnum_arr is array (natural range 0 to 49) of zeilnum;
+                       constant zn : zeilnum_arr := (
+                               0 => "00", 1 => "01", 2 => "02", 3 => "03", 4 => "04",
+                               5 => "05", 6 => "06", 7 => "07", 8 => "08", 9 => "09",
+                               10 => "10", 11 => "11", 12 => "12", 13 => "13", 14 => "14",
+                               15 => "15", 16 => "16", 17 => "17", 18 => "18", 19 => "19",
+                               20 => "20", 21 => "21", 22 => "22", 23 => "23", 24 => "24",
+                               25 => "25", 26 => "26", 27 => "27", 28 => "28", 29 => "29",
+                               30 => "30", 31 => "31", 32 => "32", 33 => "33", 34 => "34",
+                               35 => "35", 36 => "36", 37 => "37", 38 => "38", 39 => "39",
+                               40 => "40", 41 => "41", 42 => "42", 43 => "43", 44 => "44",
+                               45 => "45", 46 => "46", 47 => "47", 48 => "48", 49 => "49",
+                               others => "xy");
+                       variable t : signed(hzeile'length downto 0);
+               begin
+                       t := signed('0' & i);
+                       t := t / 2;
+                       return hbyte(to_unsigned(character'pos(zn(to_integer(t))(stelle)),8));
+               end;
        begin
                d_zeile_next <= d_zeile_int;
                d_spalte_next <= d_spalte_int;
@@ -234,12 +255,10 @@ begin
                                command_data_next <= x"ffffff" & x"28"; -- '('
                        when S_PS1_1 =>
                                command_next <= COMMAND_SET_CHAR;
-                               -- d_zeile/2, zehnerstelle
-                               command_data_next <= x"ffffff" & x"78"; -- 'x'
+                               command_data_next <= x"ffffff" & zeile2char(d_zeile_int,1); -- 'x'
                        when S_PS1_2 =>
                                command_next <= COMMAND_SET_CHAR;
-                               -- d_zeile/2, einerstelle
-                               command_data_next <= x"ffffff" & x"79"; -- 'y'
+                               command_data_next <= x"ffffff" & zeile2char(d_zeile_int,2); -- 'y'
                        when S_PS1_3 =>
                                command_next <= COMMAND_SET_CHAR;
                                command_data_next <= x"ffffff" & x"29"; -- ')'