;; This is a scheme port of the touch demo distributed with devkitpro.

;; There are a number of main entry points, each of them with differing
;; levels of abstraction to test out any problems with gambitds.

;; It also serves as an example of how to make your own programs.

(c-declare #<<c-declare-end
   
#include <nds.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>

touchPosition touchXY;
c-declare-end
)

(c-initialize "initTimers();")

(include "../../ds-lib-gambit/ds-lib.scm")
(include "../../ds-lib-gambit/irq.scm")
(include "../../ds-lib-gambit/video.scm")

(define whole-c-program (c-lambda () void #<<c-lambda-end
	irqInit();
	irqEnable(IRQ_VBLANK);

   	videoSetMode(0);	//not using the main screen
   	videoSetModeSub(MODE_0_2D | DISPLAY_BG0_ACTIVE);	//sub bg 0 will be used to print text
	vramSetBankC(VRAM_C_SUB_BG);

	SUB_BG0_CR = BG_MAP_BASE(31);

	BG_PALETTE_SUB[255] = RGB15(31,31,31);	//by default font will be rendered with color 255

	//consoleInit() is a lot more flexible but this gets you up and running quick
	consoleInitDefault((u16*)SCREEN_BASE_BLOCK_SUB(31), (u16*)CHAR_BASE_BLOCK_SUB(0), 16);

	iprintf("\n\n\tHello DS dev'rs\n");
	iprintf("\twww.drunkencoders.com");

	while (1) {
		  touchXY=touchReadXY();
		  iprintf("\x1b[10;0HTouch x = %04X, %04X\n", touchXY.x, touchXY.px);
		  iprintf("Touch y = %04X, %04X\n", touchXY.y, touchXY.py);
		  swiWaitForVBlank();
	}							  
c-lambda-end
))

(define  cheap-arse-init-video
  (c-lambda () void #<<c-lambda-end
	irqInit();
	irqEnable(IRQ_VBLANK);
			
	videoSetMode(0);	//not using the main screen
	videoSetModeSub(MODE_0_2D | DISPLAY_BG0_ACTIVE);	//sub bg 0 will be used to print text
	vramSetBankC(VRAM_C_SUB_BG);
c-lambda-end
))

(define cheap-arse-init-console (c-lambda () void #<<c-lambda-end
   
	SUB_BG0_CR = BG_MAP_BASE(31);

	BG_PALETTE_SUB[255] = RGB15(31,31,31);	//by default font will be rendered with color 255

	//consoleInit() is a lot more flexible but this gets you up and running quick
	consoleInitDefault((u16*)SCREEN_BASE_BLOCK_SUB(31), (u16*)CHAR_BASE_BLOCK_SUB(0), 16);

	iprintf("\n\n\tHello DS dev'rs\n");
	iprintf("\twww.drunkencoders.com");
c-lambda-end
)) 					


(define  cheap-arse-set-video (c-lambda () void #<<c-lambda-end
	irqInit();
	irqEnable(IRQ_VBLANK);

	videoSetMode(0);	//not using the main screen
	videoSetModeSub(MODE_0_2D | DISPLAY_BG0_ACTIVE);	//sub bg 0 will be used to print text
	vramSetBankC(VRAM_C_SUB_BG);

	SUB_BG0_CR = BG_MAP_BASE(31);

	BG_PALETTE_SUB[255] = RGB15(31,31,31);	//by default font will be rendered with color 255

	//consoleInit() is a lot more flexible but this gets you up and running quick
	consoleInitDefault((u16*)SCREEN_BASE_BLOCK_SUB(31), (u16*)CHAR_BASE_BLOCK_SUB(0), 16);

	iprintf("\n\n\tHello DS dev'rs\n");
	iprintf("\twww.drunkencoders.com");
c-lambda-end
)) 					

(define cheap-arse-display-and-wait (c-lambda () void #<<c-lambda-end
											  touchXY=touchReadXY();
											  iprintf("\x1b[10;0HTouch x = %04X, %04X\n", touchXY.x, touchXY.px);
											  iprintf("Touch y = %04X, %04X\n", touchXY.y, touchXY.py);

											  swiWaitForVBlank();
c-lambda-end
))


; definitions from video.h
(define (video-get-bg-base type base)
  (case type
	((tile) (arithmetic-shift base 2))
	((map) (arithmetic-shift base 8))
	((bmp) (arithmetic-shift base 8))
	(else (error "Unknown BG_x_BASE "))))

(define vram-set-bank-c (c-lambda () void "vramSetBankC(VRAM_C_SUB_BG);"))

; Totally Yucky.
(define video-set-sub-bg0-cr! (c-lambda (unsigned-int) void "SUB_BG0_CR = ___arg1;"))
; Again, this is kinda yucky.  A macro that writes the c-lambda instead would be nice.
(define video-set-bg-palette-sub! (c-lambda (unsigned-int unsigned-int unsigned-int unsigned-int)
									 void
									 "BG_PALETTE_SUB[___arg1] = RGB15(___arg2, ___arg3, ___arg4);"))

;This is kinda dumb, but untill I know more about this function, this is it.
(define console-init-default (c-lambda () void "consoleInitDefault((u16*)SCREEN_BASE_BLOCK_SUB(31), (u16*)CHAR_BASE_BLOCK_SUB(0), 16);"))


(c-define-type touchPosition "touchPosition")
(define touch-read-xy (c-lambda () touchPosition "touchReadXY"))
(define ds-display (c-lambda (char-string) void "iprintf"))
(define get-touch-x (c-lambda (touchPosition) unsigned-int "___result = ___arg1.x;"))
(define get-touch-y (c-lambda (touchPosition) unsigned-int "___result = ___arg1.y;"))


(define (scheme-init-console)
  (irq-init)
  (irq-enable (ds-get-bit irq-bits 'vblank))
  (video-set-mode 0)
  (video-set-mode-sub (bitwise-ior (ds-get-mode '0-2d)
								   (ds-get-bit display-bits 'bg0-active)))
  (vram-set-bank-c))

(define (scheme-init-irq)
  (irq-init)
  (irq-enable (ds-get-bit irq-bits 'vblank)))


(define (scheme-init-video)
  (cheap-arse-init-video)
										;SUB_BG0_CR = BG_MAP_BASE(31);  
  (video-set-sub-bg0-cr! (video-get-bg-base 'map 31))
  (video-set-bg-palette-sub! 255 31 31 29)
										;BG_PALETTE_SUB[255] = RGB15(31,31,31);	//by default font will be rendered with color 255

  (console-init-default) ;	consoleInitDefault((u16*)SCREEN_BASE_BLOCK_SUB(31), (u16*)CHAR_BASE_BLOCK_SUB(0), 16);
  (ds-display "\n\n\t WHOOT\n\n"))


(define (touch-loop)
  (let ((touch  (touch-read-xy)))
	(ds-display (string-append "\x1b[10;0HTouch x = " (number->string (get-touch-x touch)) "\n")) 
	(ds-display (string-append "Touch y = " (number->string (get-touch-y touch)) "\n"))) 
  (touch-loop))

(define (main-scheme-full)
  (scheme-init-console)
  (scheme-init-video)
  (touch-loop)
  0)

(define (main-scheme-mostly-full)
  (scheme-init-irq)
  (video-set-mode 0)
  (video-set-mode-sub (bitwise-ior (ds-get-mode '0-2d)
								   (ds-get-bit display-bits 'bg0-active)))
  ((c-lambda () void "
	//videoSetModeSub(MODE_0_2D | DISPLAY_BG0_ACTIVE);	//sub bg 0 will be used to print text
	//vramSetBankC(VRAM_C_SUB_BG);"))
  (vram-set-bank-c)
  (scheme-init-video)
  (touch-loop)
  0)

(define (main-scheme-video)
  (cheap-arse-init-console)
  (scheme-init-video)
  (touch-loop)
  0)

(define (main-scheme-console)
  (scheme-init-console)
  (cheap-arse-init-video)
  (touch-loop)
  0)

(define (main-scheme-old-3)
  (cheap-arse-init-video)
  (cheap-arse-init-console)
  (touch-loop)
  0)

(define (main-scheme-old-2)
  (cheap-arse-set-video)
  (touch-loop)
  0)

(define (main-scheme-old-1)
  (define (touch-loop)
	(cheap-arse-display-and-wait)
	(touch-loop))
  (cheap-arse-set-video)
  (touch-loop)
  0)

(define (main-scheme-old)
  (whole-c-program))


(define main-scheme main-scheme-full)

(main-scheme)