sed156x.c 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566
  1. /*
  2. * (C) Copyright 2003
  3. *
  4. * Pantelis Antoniou <panto@intracom.gr>
  5. * Intracom S.A.
  6. *
  7. * See file CREDITS for list of people who contributed to this
  8. * project.
  9. *
  10. * This program is free software; you can redistribute it and/or
  11. * modify it under the terms of the GNU General Public License as
  12. * published by the Free Software Foundation; either version 2 of
  13. * the License, or (at your option) any later version.
  14. *
  15. * This program is distributed in the hope that it will be useful,
  16. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  18. * GNU General Public License for more details.
  19. *
  20. * You should have received a copy of the GNU General Public License
  21. * along with this program; if not, write to the Free Software
  22. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  23. * MA 02111-1307 USA
  24. */
  25. #include <common.h>
  26. #include <watchdog.h>
  27. #include <sed156x.h>
  28. #ifdef CONFIG_SED156X
  29. /* configure according to the selected display */
  30. #if defined(CONFIG_SED156X_PG12864Q)
  31. #define LCD_WIDTH 128
  32. #define LCD_HEIGHT 64
  33. #define LCD_LINES 64
  34. #define LCD_PAGES 9
  35. #define LCD_COLUMNS 132
  36. #else
  37. #error Unsupported SED156x configuration
  38. #endif
  39. /* include the font data */
  40. #include <video_font.h>
  41. #if VIDEO_FONT_WIDTH != 8 || VIDEO_FONT_HEIGHT != 16
  42. #error Expecting VIDEO_FONT_WIDTH == 8 && VIDEO_FONT_HEIGHT == 16
  43. #endif
  44. #define LCD_BYTE_WIDTH (LCD_WIDTH / 8)
  45. #define VIDEO_FONT_BYTE_WIDTH (VIDEO_FONT_WIDTH / 8)
  46. #define LCD_TEXT_WIDTH (LCD_WIDTH / VIDEO_FONT_WIDTH)
  47. #define LCD_TEXT_HEIGHT (LCD_HEIGHT / VIDEO_FONT_HEIGHT)
  48. #define LCD_BYTE_LINESZ (LCD_BYTE_WIDTH * VIDEO_FONT_HEIGHT)
  49. const int sed156x_text_width = LCD_TEXT_WIDTH;
  50. const int sed156x_text_height = LCD_TEXT_HEIGHT;
  51. /**************************************************************************************/
  52. #define SED156X_SPI_RXD() (SED156X_SPI_RXD_PORT & SED156X_SPI_RXD_MASK)
  53. #define SED156X_SPI_TXD(x) \
  54. do { \
  55. if (x) \
  56. SED156X_SPI_TXD_PORT |= SED156X_SPI_TXD_MASK; \
  57. else \
  58. SED156X_SPI_TXD_PORT &= ~SED156X_SPI_TXD_MASK; \
  59. } while(0)
  60. #define SED156X_SPI_CLK(x) \
  61. do { \
  62. if (x) \
  63. SED156X_SPI_CLK_PORT |= SED156X_SPI_CLK_MASK; \
  64. else \
  65. SED156X_SPI_CLK_PORT &= ~SED156X_SPI_CLK_MASK; \
  66. } while(0)
  67. #define SED156X_SPI_CLK_TOGGLE() (SED156X_SPI_CLK_PORT ^= SED156X_SPI_CLK_MASK)
  68. #define SED156X_SPI_BIT_DELAY() /* no delay */
  69. #define SED156X_CS(x) \
  70. do { \
  71. if (x) \
  72. SED156X_CS_PORT |= SED156X_CS_MASK; \
  73. else \
  74. SED156X_CS_PORT &= ~SED156X_CS_MASK; \
  75. } while(0)
  76. #define SED156X_A0(x) \
  77. do { \
  78. if (x) \
  79. SED156X_A0_PORT |= SED156X_A0_MASK; \
  80. else \
  81. SED156X_A0_PORT &= ~SED156X_A0_MASK; \
  82. } while(0)
  83. /**************************************************************************************/
  84. /*** LCD Commands ***/
  85. #define LCD_ON 0xAF /* Display ON */
  86. #define LCD_OFF 0xAE /* Display OFF */
  87. #define LCD_LADDR 0x40 /* Display start line set + (6-bit) address */
  88. #define LCD_PADDR 0xB0 /* Page address set + (4-bit) page */
  89. #define LCD_CADRH 0x10 /* Column address set upper + (4-bit) column hi */
  90. #define LCD_CADRL 0x00 /* Column address set lower + (4-bit) column lo */
  91. #define LCD_ADC_NRM 0xA0 /* ADC select Normal */
  92. #define LCD_ADC_REV 0xA1 /* ADC select Reverse */
  93. #define LCD_DSP_NRM 0xA6 /* LCD display Normal */
  94. #define LCD_DSP_REV 0xA7 /* LCD display Reverse */
  95. #define LCD_DPT_NRM 0xA4 /* Display all points Normal */
  96. #define LCD_DPT_ALL 0xA5 /* Display all points ON */
  97. #define LCD_BIAS9 0xA2 /* LCD bias set 1/9 */
  98. #define LCD_BIAS7 0xA3 /* LCD bias set 1/7 */
  99. #define LCD_CAINC 0xE0 /* Read/modify/write */
  100. #define LCD_CAEND 0xEE /* End */
  101. #define LCD_RESET 0xE2 /* Reset */
  102. #define LCD_C_NRM 0xC0 /* Common output mode select Normal direction */
  103. #define LCD_C_RVS 0xC8 /* Common output mode select Reverse direction */
  104. #define LCD_PWRMD 0x28 /* Power control set + (3-bit) mode */
  105. #define LCD_RESRT 0x20 /* V5 v. reg. int. resistor ratio set + (3-bit) ratio */
  106. #define LCD_EVSET 0x81 /* Electronic volume mode set + byte = (6-bit) volume */
  107. #define LCD_SIOFF 0xAC /* Static indicator OFF */
  108. #define LCD_SION 0xAD /* Static indicator ON + byte = (2-bit) mode */
  109. #define LCD_NOP 0xE3 /* NOP */
  110. #define LCD_TEST 0xF0 /* Test/Test mode reset (Note: *DO NOT USE*) */
  111. /*-------------------------------------------------------------------------------
  112. Compound commands
  113. -------------------------------------------------------------------------------
  114. Command Description Commands
  115. ---------- ------------------------ -------------------------------------
  116. POWS_ON POWER SAVER ON command LCD_OFF, LCD_D_ALL
  117. POWS_OFF POWER SAVER OFF command LCD_D_NRM
  118. SLEEPON SLEEP mode LCD_SIOFF, POWS_ON
  119. SLEEPOFF SLEEP mode cancel LCD_D_NRM, LCD_SION, LCD_SIS_???
  120. STDBYON STAND BY mode LCD_SION, POWS_ON
  121. STDBYOFF STAND BY mode cancel LCD_D_NRM
  122. -------------------------------------------------------------------------------*/
  123. /*** LCD various parameters ***/
  124. #define LCD_PPB 8 /* Pixels per byte (display is B/W, 1 bit per pixel) */
  125. /*** LCD Status byte masks ***/
  126. #define LCD_S_BUSY 0x80 /* Status Read - BUSY mask */
  127. #define LCD_S_ADC 0x40 /* Status Read - ADC mask */
  128. #define LCD_S_ONOFF 0x20 /* Status Read - ON/OFF mask */
  129. #define LCD_S_RESET 0x10 /* Status Read - RESET mask */
  130. /*** LCD commands parameter masks ***/
  131. #define LCD_M_LADDR 0x3F /* Display start line (6-bit) address mask */
  132. #define LCD_M_PADDR 0x0F /* Page address (4-bit) page mask */
  133. #define LCD_M_CADRH 0x0F /* Column address upper (4-bit) column hi mask */
  134. #define LCD_M_CADRL 0x0F /* Column address lower (4-bit) column lo mask */
  135. #define LCD_M_PWRMD 0x07 /* Power control (3-bit) mode mask */
  136. #define LCD_M_RESRT 0x07 /* V5 v. reg. int. resistor ratio (3-bit) ratio mask */
  137. #define LCD_M_EVSET 0x3F /* Electronic volume mode byte (6-bit) volume mask */
  138. #define LCD_M_SION 0x03 /* Static indicator ON (2-bit) mode mask */
  139. /*** LCD Power control cirquits control masks ***/
  140. #define LCD_PWRBSTR 0x04 /* Power control mode - Booster cirquit ON */
  141. #define LCD_PWRVREG 0x02 /* Power control mode - Voltage regulator cirquit ON */
  142. #define LCD_PWRVFOL 0x01 /* Power control mode - Voltage follower cirquit ON */
  143. /*** LCD Static indicator states ***/
  144. #define LCD_SIS_OFF 0x00 /* Static indicator register set - OFF state */
  145. #define LCD_SIS_BL 0x01 /* Static indicator register set - 1s blink state */
  146. #define LCD_SIS_RBL 0x02 /* Static indicator register set - .5s rapid blink state */
  147. #define LCD_SIS_ON 0x03 /* Static indicator register set - constantly on state */
  148. /*** LCD functions special parameters (commands) ***/
  149. #define LCD_PREVP 0x80 /* Page number for moving to previous */
  150. #define LCD_NEXTP 0x81 /* or next page */
  151. #define LCD_ERR_P 0xFF /* Error in page number */
  152. /*** LCD initialization settings ***/
  153. #define LCD_BIAS LCD_BIAS9 /* Bias: 1/9 */
  154. #define LCD_ADCMODE LCD_ADC_NRM /* ADC mode: normal */
  155. #define LCD_COMDIR LCD_C_NRM /* Common output mode: normal */
  156. #define LCD_RRATIO 0 /* Resistor ratio: 0 */
  157. #define LCD_CNTRST 0x1C /* electronic volume: 1Ch */
  158. #define LCD_POWERM (LCD_PWRBSTR | LCD_PWRVREG | LCD_PWRVFOL) /* Power mode: All on */
  159. /**************************************************************************************/
  160. static inline unsigned int sed156x_transfer(unsigned int val)
  161. {
  162. unsigned int rx;
  163. int b;
  164. rx = 0; b = 8;
  165. while (--b >= 0) {
  166. SED156X_SPI_TXD(val & 0x80);
  167. val <<= 1;
  168. SED156X_SPI_CLK_TOGGLE();
  169. SED156X_SPI_BIT_DELAY();
  170. rx <<= 1;
  171. if (SED156X_SPI_RXD())
  172. rx |= 1;
  173. SED156X_SPI_CLK_TOGGLE();
  174. SED156X_SPI_BIT_DELAY();
  175. }
  176. return rx;
  177. }
  178. unsigned int sed156x_data_transfer(unsigned int val)
  179. {
  180. unsigned int rx;
  181. SED156X_SPI_CLK(1);
  182. SED156X_CS(0);
  183. SED156X_A0(1);
  184. rx = sed156x_transfer(val);
  185. SED156X_CS(1);
  186. return rx;
  187. }
  188. void sed156x_data_block_transfer(const u8 *p, int size)
  189. {
  190. SED156X_SPI_CLK(1);
  191. SED156X_CS(0);
  192. SED156X_A0(1);
  193. while (--size >= 0)
  194. sed156x_transfer(*p++);
  195. SED156X_CS(1);
  196. }
  197. unsigned int sed156x_cmd_transfer(unsigned int val)
  198. {
  199. unsigned int rx;
  200. SED156X_SPI_CLK(1);
  201. SED156X_CS(0);
  202. SED156X_A0(0);
  203. rx = sed156x_transfer(val);
  204. SED156X_CS(1);
  205. SED156X_A0(1);
  206. return rx;
  207. }
  208. /******************************************************************************/
  209. static u8 hw_screen[LCD_PAGES][LCD_COLUMNS];
  210. static u8 last_hw_screen[LCD_PAGES][LCD_COLUMNS];
  211. static u8 sw_screen[LCD_BYTE_WIDTH * LCD_HEIGHT];
  212. void sed156x_sync(void)
  213. {
  214. int i, j, last_page;
  215. u8 *d;
  216. const u8 *s, *e, *b, *r;
  217. u8 v0, v1, v2, v3, v4, v5, v6, v7;
  218. /* copy and rotate sw_screen to hw_screen */
  219. for (i = 0; i < LCD_HEIGHT / 8; i++) {
  220. d = &hw_screen[i][0];
  221. s = &sw_screen[LCD_BYTE_WIDTH * 8 * i + LCD_BYTE_WIDTH - 1];
  222. for (j = 0; j < LCD_WIDTH / 8; j++) {
  223. v0 = s[0 * LCD_BYTE_WIDTH];
  224. v1 = s[1 * LCD_BYTE_WIDTH];
  225. v2 = s[2 * LCD_BYTE_WIDTH];
  226. v3 = s[3 * LCD_BYTE_WIDTH];
  227. v4 = s[4 * LCD_BYTE_WIDTH];
  228. v5 = s[5 * LCD_BYTE_WIDTH];
  229. v6 = s[6 * LCD_BYTE_WIDTH];
  230. v7 = s[7 * LCD_BYTE_WIDTH];
  231. d[0] = ((v7 & 0x01) << 7) |
  232. ((v6 & 0x01) << 6) |
  233. ((v5 & 0x01) << 5) |
  234. ((v4 & 0x01) << 4) |
  235. ((v3 & 0x01) << 3) |
  236. ((v2 & 0x01) << 2) |
  237. ((v1 & 0x01) << 1) |
  238. (v0 & 0x01) ;
  239. d[1] = ((v7 & 0x02) << 6) |
  240. ((v6 & 0x02) << 5) |
  241. ((v5 & 0x02) << 4) |
  242. ((v4 & 0x02) << 3) |
  243. ((v3 & 0x02) << 2) |
  244. ((v2 & 0x02) << 1) |
  245. ((v1 & 0x02) << 0) |
  246. ((v0 & 0x02) >> 1) ;
  247. d[2] = ((v7 & 0x04) << 5) |
  248. ((v6 & 0x04) << 4) |
  249. ((v5 & 0x04) << 3) |
  250. ((v4 & 0x04) << 2) |
  251. ((v3 & 0x04) << 1) |
  252. (v2 & 0x04) |
  253. ((v1 & 0x04) >> 1) |
  254. ((v0 & 0x04) >> 2) ;
  255. d[3] = ((v7 & 0x08) << 4) |
  256. ((v6 & 0x08) << 3) |
  257. ((v5 & 0x08) << 2) |
  258. ((v4 & 0x08) << 1) |
  259. (v3 & 0x08) |
  260. ((v2 & 0x08) >> 1) |
  261. ((v1 & 0x08) >> 2) |
  262. ((v0 & 0x08) >> 3) ;
  263. d[4] = ((v7 & 0x10) << 3) |
  264. ((v6 & 0x10) << 2) |
  265. ((v5 & 0x10) << 1) |
  266. (v4 & 0x10) |
  267. ((v3 & 0x10) >> 1) |
  268. ((v2 & 0x10) >> 2) |
  269. ((v1 & 0x10) >> 3) |
  270. ((v0 & 0x10) >> 4) ;
  271. d[5] = ((v7 & 0x20) << 2) |
  272. ((v6 & 0x20) << 1) |
  273. (v5 & 0x20) |
  274. ((v4 & 0x20) >> 1) |
  275. ((v3 & 0x20) >> 2) |
  276. ((v2 & 0x20) >> 3) |
  277. ((v1 & 0x20) >> 4) |
  278. ((v0 & 0x20) >> 5) ;
  279. d[6] = ((v7 & 0x40) << 1) |
  280. (v6 & 0x40) |
  281. ((v5 & 0x40) >> 1) |
  282. ((v4 & 0x40) >> 2) |
  283. ((v3 & 0x40) >> 3) |
  284. ((v2 & 0x40) >> 4) |
  285. ((v1 & 0x40) >> 5) |
  286. ((v0 & 0x40) >> 6) ;
  287. d[7] = (v7 & 0x80) |
  288. ((v6 & 0x80) >> 1) |
  289. ((v5 & 0x80) >> 2) |
  290. ((v4 & 0x80) >> 3) |
  291. ((v3 & 0x80) >> 4) |
  292. ((v2 & 0x80) >> 5) |
  293. ((v1 & 0x80) >> 6) |
  294. ((v0 & 0x80) >> 7) ;
  295. d += 8;
  296. s--;
  297. }
  298. }
  299. /* and now output only the differences */
  300. for (i = 0; i < LCD_PAGES; i++) {
  301. b = &hw_screen[i][0];
  302. e = &hw_screen[i][LCD_COLUMNS];
  303. d = &last_hw_screen[i][0];
  304. s = b;
  305. last_page = -1;
  306. /* update only the differences */
  307. do {
  308. while (s < e && *s == *d) {
  309. s++;
  310. d++;
  311. }
  312. if (s == e)
  313. break;
  314. r = s;
  315. while (s < e && *s != *d)
  316. *d++ = *s++;
  317. j = r - b;
  318. if (i != last_page) {
  319. sed156x_cmd_transfer(LCD_PADDR | i);
  320. last_page = i;
  321. }
  322. sed156x_cmd_transfer(LCD_CADRH | ((j >> 4) & 0x0F));
  323. sed156x_cmd_transfer(LCD_CADRL | (j & 0x0F));
  324. sed156x_data_block_transfer(r, s - r);
  325. } while (s < e);
  326. }
  327. /********
  328. for (i = 0; i < LCD_PAGES; i++) {
  329. sed156x_cmd_transfer(LCD_PADDR | i);
  330. sed156x_cmd_transfer(LCD_CADRH | 0);
  331. sed156x_cmd_transfer(LCD_CADRL | 0);
  332. sed156x_data_block_transfer(&hw_screen[i][0], LCD_COLUMNS);
  333. }
  334. memcpy(last_hw_screen, hw_screen, sizeof(last_hw_screen));
  335. ********/
  336. }
  337. void sed156x_clear(void)
  338. {
  339. memset(sw_screen, 0, sizeof(sw_screen));
  340. }
  341. void sed156x_output_at(int x, int y, const char *str, int size)
  342. {
  343. int i, j;
  344. u8 *p;
  345. const u8 *s;
  346. if ((unsigned int)y >= LCD_TEXT_HEIGHT || (unsigned int)x >= LCD_TEXT_WIDTH)
  347. return;
  348. p = &sw_screen[y * VIDEO_FONT_HEIGHT * LCD_BYTE_WIDTH + x * VIDEO_FONT_BYTE_WIDTH];
  349. while (--size >= 0) {
  350. s = &video_fontdata[((int)*str++ & 0xff) * VIDEO_FONT_BYTE_WIDTH * VIDEO_FONT_HEIGHT];
  351. for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
  352. for (j = 0; j < VIDEO_FONT_BYTE_WIDTH; j++)
  353. *p++ = *s++;
  354. p += LCD_BYTE_WIDTH - VIDEO_FONT_BYTE_WIDTH;
  355. }
  356. p -= (LCD_BYTE_LINESZ - VIDEO_FONT_BYTE_WIDTH);
  357. if (x >= LCD_TEXT_WIDTH)
  358. break;
  359. x++;
  360. }
  361. }
  362. void sed156x_reverse_at(int x, int y, int size)
  363. {
  364. int i, j;
  365. u8 *p;
  366. if ((unsigned int)y >= LCD_TEXT_HEIGHT || (unsigned int)x >= LCD_TEXT_WIDTH)
  367. return;
  368. p = &sw_screen[y * VIDEO_FONT_HEIGHT * LCD_BYTE_WIDTH + x * VIDEO_FONT_BYTE_WIDTH];
  369. while (--size >= 0) {
  370. for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
  371. for (j = 0; j < VIDEO_FONT_BYTE_WIDTH; j++, p++)
  372. *p = ~*p;
  373. p += LCD_BYTE_WIDTH - VIDEO_FONT_BYTE_WIDTH;
  374. }
  375. p -= (LCD_BYTE_LINESZ - VIDEO_FONT_BYTE_WIDTH);
  376. if (x >= LCD_TEXT_WIDTH)
  377. break;
  378. x++;
  379. }
  380. }
  381. void sed156x_scroll_line(void)
  382. {
  383. memmove(&sw_screen[0],
  384. &sw_screen[LCD_BYTE_LINESZ],
  385. LCD_BYTE_WIDTH * (LCD_HEIGHT - VIDEO_FONT_HEIGHT));
  386. }
  387. void sed156x_scroll(int dx, int dy)
  388. {
  389. u8 *p1 = NULL, *p2 = NULL, *p3 = NULL; /* pacify gcc */
  390. int adx, ady, i, sz;
  391. adx = dx > 0 ? dx : -dx;
  392. ady = dy > 0 ? dy : -dy;
  393. /* overscroll? erase everything */
  394. if (adx >= LCD_TEXT_WIDTH || ady >= LCD_TEXT_HEIGHT) {
  395. memset(sw_screen, 0, sizeof(sw_screen));
  396. return;
  397. }
  398. sz = LCD_BYTE_LINESZ * ady;
  399. if (dy > 0) {
  400. p1 = &sw_screen[0];
  401. p2 = &sw_screen[sz];
  402. p3 = &sw_screen[LCD_BYTE_WIDTH * LCD_HEIGHT - sz];
  403. } else if (dy < 0) {
  404. p1 = &sw_screen[sz];
  405. p2 = &sw_screen[0];
  406. p3 = &sw_screen[0];
  407. }
  408. if (ady > 0) {
  409. memmove(p1, p2, LCD_BYTE_WIDTH * LCD_HEIGHT - sz);
  410. memset(p3, 0, sz);
  411. }
  412. sz = VIDEO_FONT_BYTE_WIDTH * adx;
  413. if (dx > 0) {
  414. p1 = &sw_screen[0];
  415. p2 = &sw_screen[0] + sz;
  416. p3 = &sw_screen[0] + LCD_BYTE_WIDTH - sz;
  417. } else if (dx < 0) {
  418. p1 = &sw_screen[0] + sz;
  419. p2 = &sw_screen[0];
  420. p3 = &sw_screen[0];
  421. }
  422. /* xscroll */
  423. if (adx > 0) {
  424. for (i = 0; i < LCD_HEIGHT; i++) {
  425. memmove(p1, p2, LCD_BYTE_WIDTH - sz);
  426. memset(p3, 0, sz);
  427. p1 += LCD_BYTE_WIDTH;
  428. p2 += LCD_BYTE_WIDTH;
  429. p3 += LCD_BYTE_WIDTH;
  430. }
  431. }
  432. }
  433. void sed156x_init(void)
  434. {
  435. int i;
  436. SED156X_CS(1);
  437. SED156X_A0(1);
  438. /* Send initialization commands to the LCD */
  439. sed156x_cmd_transfer(LCD_OFF); /* Turn display OFF */
  440. sed156x_cmd_transfer(LCD_BIAS); /* set the LCD Bias, */
  441. sed156x_cmd_transfer(LCD_ADCMODE); /* ADC mode, */
  442. sed156x_cmd_transfer(LCD_COMDIR); /* common output mode, */
  443. sed156x_cmd_transfer(LCD_RESRT | LCD_RRATIO); /* resistor ratio, */
  444. sed156x_cmd_transfer(LCD_EVSET); /* electronic volume, */
  445. sed156x_cmd_transfer(LCD_CNTRST);
  446. sed156x_cmd_transfer(LCD_PWRMD | LCD_POWERM); /* and power mode */
  447. sed156x_cmd_transfer(LCD_PADDR | 0); /* cursor home */
  448. sed156x_cmd_transfer(LCD_CADRH | 0);
  449. sed156x_cmd_transfer(LCD_CADRL | 0);
  450. sed156x_cmd_transfer(LCD_LADDR | 0); /* and display start line */
  451. sed156x_cmd_transfer(LCD_DSP_NRM); /* LCD display Normal */
  452. /* clear everything */
  453. memset(sw_screen, 0, sizeof(sw_screen));
  454. memset(hw_screen, 0, sizeof(hw_screen));
  455. memset(last_hw_screen, 0, sizeof(last_hw_screen));
  456. for (i = 0; i < LCD_PAGES; i++) {
  457. sed156x_cmd_transfer(LCD_PADDR | i);
  458. sed156x_cmd_transfer(LCD_CADRH | 0);
  459. sed156x_cmd_transfer(LCD_CADRL | 0);
  460. sed156x_data_block_transfer(&hw_screen[i][0], LCD_COLUMNS);
  461. }
  462. sed156x_clear();
  463. sed156x_sync();
  464. sed156x_cmd_transfer(LCD_ON); /* Turn display ON */
  465. }
  466. #endif /* CONFIG_SED156X */