source: branches/release-1_0/platform/sx210is/main.c @ 1738

#include "lolevel.h"
#include "platform.h"
#include "core.h"
#include "keyboard.h"


extern long link_bss_start;
extern long link_bss_end;
extern void boot();


void startup()
{


        long *bss = &link_bss_start;
        long *ptr;

        // sanity check
        if ((long)&link_bss_end > (MEMISOSTART + MEMISOSIZE)){
                started();
                shutdown();
        }

        // initialize .bss senment
        while (bss<&link_bss_end)
                *bss++ = 0;


        boot();
}


//zoom position is get_parameter_data(87)
static const struct {
        int zp, fl;
} fl_tbl[] = {
  {   0,   5000},
  {  16,   6800},
  {  32,   9100},
  {  62,  16200},
  {  78,  22300},
  { 102,  35900},
  { 125,  70000},
};
#define NUM_FL (sizeof(fl_tbl)/sizeof(fl_tbl[0]))


// Focal length range is 5.0 - 70,0 mm, 27.3 - 392 in 35-mm equivalent.
// So, CF_EFL = 27.3/5.0*10000=54600 or392/70*10000=56000
// diff = 54600 - 54566.6 = 1400, split it 1400 / 2 = 700
// add to base 56000 + 700 = 56700
// divide by 10 to avoid overflow in get_effective_focal_length()
#define CF_EFL  5670
const int zoom_points = 126;

int get_effective_focal_length(int zp) {
        return (CF_EFL*get_focal_length(zp))/1000;
}

int get_focal_length(int zp) {
        int i;

        if (zp<fl_tbl[0].zp)
                return fl_tbl[0].fl;
        else if (zp>fl_tbl[NUM_FL-1].zp)
                return fl_tbl[NUM_FL-1].fl;
        else
                for (i=1; i<NUM_FL; ++i) {
                        if (zp==fl_tbl[i-1].zp)
                                return fl_tbl[i-1].fl;
                        else if (zp==fl_tbl[i].zp)
                                return fl_tbl[i].fl;
                        else if (zp<fl_tbl[i].zp)
                                return fl_tbl[i-1].fl+(zp-fl_tbl[i-1].zp)*(fl_tbl[i].fl-fl_tbl[i-1].fl)/(fl_tbl[i].zp-fl_tbl[i-1].zp);
                }
        return fl_tbl[NUM_FL-1].fl;
}

int get_zoom_x(int zp) {
        return get_focal_length(zp)*10/fl_tbl[0].fl;
}


long get_vbatt_min()
{
        return 3280;  // min observed was 3.408, then it died
}

long get_vbatt_max()
{
        return 4057;  // fresh from change (actual was 4.127)
}