diff options
Diffstat (limited to 'src/main.c')
| -rw-r--r-- | src/main.c | 88 |
1 files changed, 88 insertions, 0 deletions
diff --git a/src/main.c b/src/main.c new file mode 100644 index 0000000..4982ba0 --- /dev/null +++ b/src/main.c @@ -0,0 +1,88 @@ +#include "CH58x_common.h"
+#include "CH58x_sys.h"
+#include "leddrv.h"
+
+#define FB_WIDTH LED_COLS*4
+#define SCROLL_IRATIO 3
+
+uint16_t fb[2][FB_WIDTH];
+
+uint8_t test_font[][11] = {
+ 0x00, 0xFE, 0x66, 0x62, 0x68, 0x78, 0x68, 0x60, 0x60, 0xF0, 0x00, // F
+ 0x00, 0x7C, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0xC6, 0x7C, 0x00, // O
+ 0x00, 0x7C, 0xC6, 0xC6, 0x60, 0x38, 0x0C, 0xC6, 0xC6, 0x7C, 0x00, // S
+ 0x00, 0x7C, 0xC6, 0xC6, 0x60, 0x38, 0x0C, 0xC6, 0xC6, 0x7C, 0x00, // S
+ 0x00, 0x38, 0x6C, 0xC6, 0xC6, 0xFE, 0xC6, 0xC6, 0xC6, 0xC6, 0x00, // A
+ 0x00, 0x7C, 0xC6, 0xC6, 0x60, 0x38, 0x0C, 0xC6, 0xC6, 0x7C, 0x00, // S
+ 0x00, 0x3C, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3C, 0x00, // I
+ 0x00, 0x38, 0x6C, 0xC6, 0xC6, 0xFE, 0xC6, 0xC6, 0xC6, 0xC6, 0x00, // A
+};
+
+void draw2fb(uint16_t *fb, int c, int col)
+{
+ uint16_t tmpfb[8] = {0};
+ for (int i=0; i<8; i++) {
+ for (int j=0; j<11; j++) {
+ tmpfb[i] |= ((test_font[c][j] >> (8-i)) & 0x01) << j;
+ }
+ }
+ for (int i=0; i<8; i++) {
+ fb[col+i] = tmpfb[i];
+ }
+}
+
+volatile int fb_sel = 0;
+
+int main()
+{
+ SetSysClock(CLK_SOURCE_PLL_60MHz);
+
+ led_init();
+ draw2fb(fb[0], 0, 8*5);
+ draw2fb(fb[0], 1, 8*6);
+ draw2fb(fb[0], 2, 8*7);
+ draw2fb(fb[0], 3, 8*8);
+ draw2fb(fb[0], 4, 8*9);
+ draw2fb(fb[0], 5, 8*10);
+ draw2fb(fb[0], 6, 8*11);
+ draw2fb(fb[0], 7, 8*12);
+
+ draw2fb(fb[1], 4, 8*5);
+ draw2fb(fb[1], 5, 8*6);
+ draw2fb(fb[1], 6, 8*7);
+ draw2fb(fb[1], 7, 8*8);
+ draw2fb(fb[1], 0, 8*9);
+ draw2fb(fb[1], 1, 8*10);
+ draw2fb(fb[1], 2, 8*11);
+ draw2fb(fb[1], 3, 8*12);
+
+ TMR0_TimerInit(1500);
+ TMR0_ITCfg(ENABLE, TMR0_3_IT_CYC_END);
+ PFIC_EnableIRQ(TMR0_IRQn);
+
+ while (1) {
+ }
+}
+
+__attribute__((interrupt))
+void TMR0_IRQHandler(void)
+{
+ static int i, scroll;
+
+ if (TMR0_GetITFlag(TMR0_3_IT_CYC_END)) {
+
+ i += 2;
+ if (i >= LED_COLS) {
+ i = 0;
+ scroll++;
+ if (scroll >= (FB_WIDTH-LED_COLS)*SCROLL_IRATIO) {
+ scroll = 0;
+ fb_sel = fb_sel == 0;
+ }
+ }
+ // This is a mess
+ led_write2dcol(i/2, fb[fb_sel][i+scroll/SCROLL_IRATIO], fb[fb_sel][i+scroll/SCROLL_IRATIO+1]);
+
+ TMR0_ClearITFlag(TMR0_3_IT_CYC_END);
+ }
+}
|