Avoid duplicated code, create a formatting function for FM frequency
[kugel-rb.git] / bootloader / meizu_m6sl.c
blob0b335bec8aa601c4808e26268f439fa544f34e3b
1 /***************************************************************************
2 * __________ __ ___.
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
7 * \/ \/ \/ \/ \/
8 * $Id$
10 * Copyright (C) 2006 by Greg White
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License
14 * as published by the Free Software Foundation; either version 2
15 * of the License, or (at your option) any later version.
17 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
18 * KIND, either express or implied.
20 ****************************************************************************/
21 #include "config.h"
23 #include <stdlib.h>
24 #include <stdio.h>
25 #include "inttypes.h"
26 #include "string.h"
27 #include "cpu.h"
28 #include "system.h"
29 #include "lcd.h"
30 #include "kernel.h"
31 #include "thread.h"
32 #include "storage.h"
33 #include "fat.h"
34 #include "disk.h"
35 #include "font.h"
36 #include "adc.h"
37 #include "backlight.h"
38 #include "backlight-target.h"
39 #include "button.h"
40 #include "panic.h"
41 #include "power.h"
42 #include "file.h"
43 #include "common.h"
44 #include "rbunicode.h"
45 #include "usb.h"
46 #include "qt1106.h"
48 #include <stdarg.h>
50 char version[] = APPSVERSION;
51 #define LONG_DELAY 200000
52 #define SHORT_DELAY 50000
53 #define PAUSE_DELAY 50000
55 static inline void delay(int duration)
57 volatile int i;
58 for(i=0;i<duration;i++);
62 void bl_debug(bool bit)
64 if (bit)
66 PDAT0 ^= (1 << 2); //Toggle backlight
67 delay(LONG_DELAY);
68 PDAT0 ^= (1 << 2); //Toggle backlight
69 delay(LONG_DELAY);
71 else
73 PDAT0 ^= (1 << 2); //Toggle backlight
74 delay(SHORT_DELAY);
75 PDAT0 ^= (1 << 2); //Toggle backlight
76 delay(SHORT_DELAY);
80 void bl_debug_count(unsigned int input)
82 unsigned int i;
83 delay(SHORT_DELAY*3);
84 for (i = 0; i < input; i++)
86 PDAT0 ^= (1 << 2); //Toggle backlight
87 delay(SHORT_DELAY);
88 PDAT0 ^= (1 << 2); //Toggle backlight
89 delay(2*SHORT_DELAY);
92 void bl_debug_int(unsigned int input,unsigned int count)
94 unsigned int i;
95 for (i = 0; i < count; i++)
97 bl_debug(input>>i & 1);
99 delay(SHORT_DELAY*6);
102 /* These functions are supposed to be static in lcd-m6sl.c, but
103 we use them here for testing */
104 void init_lcd_spi(void);
105 unsigned int lcd_read_id(void);
107 void main(void)
109 //Set backlight pin to output and enable
110 unsigned int model;
111 int oldval = PCON0;
112 PCON0 = ((oldval & ~(3 << 4)) | (1 << 4));
113 PDAT0 |= (1 << 2);
115 //Set PLAY to input
116 oldval = PCON1;
117 PCON1 = ((oldval & ~(0xf << 16)) | (0 << 16));
119 init_qt1106();
121 // Wait for play to be pressed
122 while(!(PDAT1 & (1 << 4)));
123 // Wait for play to be released
124 while((PDAT1 & (1 << 4)));
125 PDAT0 ^= (1 << 2); //Toggle backlight
126 delay(LONG_DELAY);
128 init_lcd_spi();
129 model=lcd_read_id();
130 bl_debug_count((model&0xf000)>>12);
131 bl_debug_count((model&0xf00)>>8);
132 bl_debug_count((model&0xf0)>>4);
133 bl_debug_count(model&0xf);
135 /* Calibrate the lot */
136 qt1106_io(QT1106_MODE_FREE | QT1106_MOD_INF | QT1106_DI \
137 | QT1106_SLD_SLIDER | QT1106_CAL_WHEEL | QT1106_CAL_KEYS | QT1106_RES_4);
139 /* Set to maximum sensitivity */
140 qt1106_io(QT1106_CT | (0x00 << 8) );
142 while(true)
144 qt1106_wait();
146 int slider = qt1106_io(QT1106_MODE_FREE | QT1106_MOD_INF \
147 | QT1106_DI | QT1106_SLD_SLIDER | QT1106_RES_4);
148 if(slider & 0x008000)
149 bl_debug_count(((slider&0xff)) + 1);
152 //power off
153 PDAT1&=~(1<<3);