← Back to branch summary

~pmdj/ubuntu/trusty/qemu/2.9+applesmc+fadtv3

« back to all changes in this revision

Viewing changes to roms/u-boot/board/cogent/lcd.c

  • Committer: Phil Dennis-Jordan
  • Date: 2017-07-21 08:03:43 UTC
  • mfrom: (1.1.1)
  • Revision ID: phil@philjordan.eu-20170721080343-2yr2vdj7713czahv
New upstream release 2.9.0.

Show diffs side-by-side

added added

removed removed

Lines of Context:
roms/u-boot/board/cogent/lcd.c
 
1
/* most of this is taken from the file */
 
2
/* hal/powerpc/cogent/current/src/hal_diag.c in the */
 
3
/* Cygnus eCos source. Here is the copyright notice: */
 
4
/* */
 
5
/*============================================================================= */
 
6
/* */
 
7
/*      hal_diag.c */
 
8
/* */
 
9
/*      HAL diagnostic output code */
 
10
/* */
 
11
/*============================================================================= */
 
12
/*####COPYRIGHTBEGIN#### */
 
13
/* */
 
14
/* ------------------------------------------- */
 
15
/* The contents of this file are subject to the Cygnus eCos Public License */
 
16
/* Version 1.0 (the "License"); you may not use this file except in */
 
17
/* compliance with the License.  You may obtain a copy of the License at */
 
18
/* http://sourceware.cygnus.com/ecos */
 
19
/* */
 
20
/* Software distributed under the License is distributed on an "AS IS" */
 
21
/* basis, WITHOUT WARRANTY OF ANY KIND, either express or implied.  See the */
 
22
/* License for the specific language governing rights and limitations under */
 
23
/* the License. */
 
24
/* */
 
25
/* The Original Code is eCos - Embedded Cygnus Operating System, released */
 
26
/* September 30, 1998. */
 
27
/* */
 
28
/* The Initial Developer of the Original Code is Cygnus.  Portions created */
 
29
/* by Cygnus are Copyright (C) 1998,1999 Cygnus Solutions.  All Rights Reserved. */
 
30
/* ------------------------------------------- */
 
31
/* */
 
32
/*####COPYRIGHTEND#### */
 
33
/*============================================================================= */
 
34
/*#####DESCRIPTIONBEGIN#### */
 
35
/* */
 
36
/* Author(s):    nickg, jskov */
 
37
/* Contributors: nickg, jskov */
 
38
/* Date:         1999-03-23 */
 
39
/* Purpose:      HAL diagnostic output */
 
40
/* Description:  Implementations of HAL diagnostic output support. */
 
41
/* */
 
42
/*####DESCRIPTIONEND#### */
 
43
/* */
 
44
/*============================================================================= */
 
45
 
 
46
/*----------------------------------------------------------------------------- */
 
47
/* Cogent board specific LCD code */
 
48
 
 
49
#include <common.h>
 
50
#include <stdarg.h>
 
51
#include "lcd.h"
 
52
 
 
53
static char lines[2][LCD_LINE_LENGTH+1];
 
54
static int curline;
 
55
static int linepos;
 
56
static int heartbeat_active;
 
57
/* make the next two strings exactly LCD_LINE_LENGTH (16) chars long */
 
58
/* pad to the right with spaces if necessary */
 
59
static char init_line0[LCD_LINE_LENGTH+1] = "U-Boot Cogent  ";
 
60
static char init_line1[LCD_LINE_LENGTH+1] = "mjj, 11 Aug 2000";
 
61
 
 
62
static inline unsigned char
 
63
lcd_read_status(cma_mb_lcd *clp)
 
64
{
 
65
    /* read the Busy Status Register */
 
66
    return (cma_mb_reg_read(&clp->lcd_bsr));
 
67
}
 
68
 
 
69
static inline void
 
70
lcd_wait_not_busy(cma_mb_lcd *clp)
 
71
{
 
72
    /*
 
73
     * wait for not busy
 
74
     * Note: It seems that the LCD isn't quite ready to process commands
 
75
     * when it clears the BUSY flag. Reading the status address an extra
 
76
     * time seems to give it enough breathing room.
 
77
     */
 
78
 
 
79
    while (lcd_read_status(clp) & LCD_STAT_BUSY)
 
80
        ;
 
81
 
 
82
    (void)lcd_read_status(clp);
 
83
}
 
84
 
 
85
static inline void
 
86
lcd_write_command(cma_mb_lcd *clp, unsigned char cmd)
 
87
{
 
88
    lcd_wait_not_busy(clp);
 
89
 
 
90
    /* write the Command Register */
 
91
    cma_mb_reg_write(&clp->lcd_cmd, cmd);
 
92
}
 
93
 
 
94
static inline void
 
95
lcd_write_data(cma_mb_lcd *clp, unsigned char data)
 
96
{
 
97
    lcd_wait_not_busy(clp);
 
98
 
 
99
    /* write the Current Character Register */
 
100
    cma_mb_reg_write(&clp->lcd_ccr, data);
 
101
}
 
102
 
 
103
static inline void
 
104
lcd_dis(int addr, char *string)
 
105
{
 
106
    cma_mb_lcd *clp = (cma_mb_lcd *)CMA_MB_LCD_BASE;
 
107
    int pos, linelen;
 
108
 
 
109
    linelen = LCD_LINE_LENGTH;
 
110
    if (heartbeat_active && addr == LCD_LINE0)
 
111
        linelen--;
 
112
 
 
113
    lcd_write_command(clp, LCD_CMD_ADD + addr);
 
114
    for (pos = 0; *string != '\0' && pos < linelen; pos++)
 
115
        lcd_write_data(clp, *string++);
 
116
}
 
117
 
 
118
void
 
119
lcd_init(void)
 
120
{
 
121
    cma_mb_lcd *clp = (cma_mb_lcd *)CMA_MB_LCD_BASE;
 
122
    int i;
 
123
 
 
124
    /* configure the lcd for 8 bits/char, 2 lines and 5x7 dot matrix */
 
125
    lcd_write_command(clp, LCD_CMD_MODE);
 
126
 
 
127
    /* turn the LCD display on */
 
128
    lcd_write_command(clp, LCD_CMD_DON);
 
129
 
 
130
    curline = 0;
 
131
    linepos = 0;
 
132
 
 
133
    for (i = 0; i < LCD_LINE_LENGTH; i++) {
 
134
        lines[0][i] = init_line0[i];
 
135
        lines[1][i] = init_line1[i];
 
136
    }
 
137
 
 
138
    lines[0][LCD_LINE_LENGTH] = lines[1][LCD_LINE_LENGTH] = 0;
 
139
 
 
140
    lcd_dis(LCD_LINE0, lines[0]);
 
141
    lcd_dis(LCD_LINE1, lines[1]);
 
142
 
 
143
    printf("HD44780 2 line x %d char display\n", LCD_LINE_LENGTH);
 
144
}
 
145
 
 
146
void
 
147
lcd_write_char(const char c)
 
148
{
 
149
    int i, linelen;
 
150
 
 
151
    /* ignore CR */
 
152
    if (c == '\r')
 
153
        return;
 
154
 
 
155
    linelen = LCD_LINE_LENGTH;
 
156
    if (heartbeat_active && curline == 0)
 
157
        linelen--;
 
158
 
 
159
    if (c == '\n') {
 
160
        lcd_dis(LCD_LINE0, &lines[curline^1][0]);
 
161
        lcd_dis(LCD_LINE1, &lines[curline][0]);
 
162
 
 
163
        /* Do a line feed */
 
164
        curline ^= 1;
 
165
        linelen = LCD_LINE_LENGTH;
 
166
        if (heartbeat_active && curline == 0)
 
167
            linelen--;
 
168
        linepos = 0;
 
169
 
 
170
        for (i = 0; i < linelen; i++)
 
171
            lines[curline][i] = ' ';
 
172
 
 
173
        return;
 
174
    }
 
175
 
 
176
    /* Only allow to be output if there is room on the LCD line */
 
177
    if (linepos < linelen)
 
178
        lines[curline][linepos++] = c;
 
179
}
 
180
 
 
181
void
 
182
lcd_flush(void)
 
183
{
 
184
    lcd_dis(LCD_LINE1, &lines[curline][0]);
 
185
}
 
186
 
 
187
void
 
188
lcd_write_string(const char *s)
 
189
{
 
190
    char *p;
 
191
 
 
192
    for (p = (char *)s; *p != '\0'; p++)
 
193
        lcd_write_char(*p);
 
194
}
 
195
 
 
196
void
 
197
lcd_printf(const char *fmt, ...)
 
198
{
 
199
    va_list args;
 
200
    char buf[CONFIG_SYS_PBSIZE];
 
201
 
 
202
    va_start(args, fmt);
 
203
    (void)vsprintf(buf, fmt, args);
 
204
    va_end(args);
 
205
 
 
206
    lcd_write_string(buf);
 
207
}
 
208
 
 
209
void
 
210
lcd_heartbeat(void)
 
211
{
 
212
    cma_mb_lcd *clp = (cma_mb_lcd *)CMA_MB_LCD_BASE;
 
213
#if 0
 
214
    static char rotchars[] = { '|', '/', '-', '\\' };
 
215
#else
 
216
    /* HD44780 Rom Code A00 has no backslash */
 
217
    static char rotchars[] = { '|', '/', '-', '\315' };
 
218
#endif
 
219
    static int rotator_index = 0;
 
220
 
 
221
    heartbeat_active = 1;
 
222
 
 
223
    /* write the address */
 
224
    lcd_write_command(clp, LCD_CMD_ADD + LCD_LINE0 + (LCD_LINE_LENGTH - 1));
 
225
 
 
226
    /* write the next char in the sequence */
 
227
    lcd_write_data(clp, rotchars[rotator_index]);
 
228
 
 
229
    if (++rotator_index >= (sizeof rotchars / sizeof rotchars[0]))
 
230
        rotator_index = 0;
 
231
}
 
232
 
 
233
#ifdef CONFIG_SHOW_ACTIVITY
 
234
void board_show_activity (ulong timestamp)
 
235
{
 
236
#ifdef CONFIG_STATUS_LED
 
237
        if ((timestamp % (CONFIG_SYS_HZ / 2) == 0)
 
238
                lcd_heartbeat ();
 
239
#endif
 
240
}
 
241
 
 
242
void show_activity(int arg)
 
243
{
 
244
}
 
245
#endif