#include "platform.h"
#include "lolevel.h"
#include "leds.h"

void shutdown()
{
    volatile long *p = (void*)0xc02200a0;
        
    asm(
         "MRS     R1, CPSR\n"
         "AND     R0, R1, #0x80\n"
         "ORR     R1, R1, #0x80\n"
         "MSR     CPSR_cf, R1\n"
         :::"r1","r0");
        
    *p = 0x44;

    while(1);
}

void debug_led(int state)
{
	volatile long *p=(void*)LED_ORANGE;
	if (state)
	p[0]=0x46;
	else
	p[0]=0x44;
}

void debug_led_c(int color, int state)
{
    volatile long *p;
	if (color==0)
		p=(void*)LED_PR;
	else if (color==1)
		p=(void*)LED_GREEN;
	else if (color==2)
		p=(void*)LED_ORANGE;
	else
		p=(void*)LED_AF;

    if (state)
	p[0]=0x46;
    else
	p[0]=0x44;
}

//  fe50 10-Aug-2008
void camera_set_led(int led, int state, __attribute__ ((unused))int bright)
{
	// "brigth" not implemented
	// YELLOW not available
	// TIMER -> LED_AF
	int leds[] = {0x134,0x130,0x134,0x130,0xd4,0x3030,0x3030};  //  green=4 | (yellow) | (not used) | orange | blue | af beam | timer
//	if(led < 4 || led > 10 || led == 6)  //  map to valid params;  no extra TIMER LED (is same as AF)
	volatile long *p=(void*)0xc0220000 + leds[(led-4)%sizeof(leds)];
	if (state)
		p[0]=0x46;
	else
		p[0]=0x44;
}

//void camera_set_led(int led, int state, __attribute__ ((unused))int bright)
//{
//	static char led_table[5]={4,5,7,8,9};
//	_LEDDrive(led_table[led%sizeof(led_table)], state<=1 ? !state : state);
//}

void JogDial_CW(void)
{
	_PostLogicalEventForNotPowerType(0x874, 1);  // RotateJogDialRight
}

void JogDial_CCW(void)
{
	_PostLogicalEventForNotPowerType(0x875, 1);  // RotateJogDialLeft
}

// 0x73 @ FF95D668
int get_flash_params_count(void) { return 115; }

// PTP display stuff
// TODO type may not be correct
int vid_get_palette_type() { return 1; }
int vid_get_palette_size() { return 16*4; }

void *vid_get_bitmap_active_palette() 
{
    return (void *)0x3EF20;        //Found @ 0xff8eaf94 - Two refs to "BmpDDev"
}

void *vid_get_bitmap_active_buffer() 
{
    return (void*)(*(int*)0x7EC8); //Found @ 0xff8eaf94 - Two refs to "BmpDDev"
}