root/platform/sx40hs/main.c

DEFINITIONS

1. startup
2. screen_opened
3. screen_rotated
4. get_effective_focal_length
5. get_focal_length
6. get_zoom_x
7. get_vbatt_min
8. get_vbatt_max

   1 #include "lolevel.h"
   2 #include "platform.h"
   3 #include "core.h"
   4 #include "keyboard.h"
   7 extern long link_bss_start;
   8 extern long link_bss_end;
   9 extern void boot();
  12 void startup()
  13 {
  14         long *bss = &link_bss_start;
  16         // sanity check
  17         if ((long)&link_bss_end > (MEMISOSTART + MEMISOSIZE)){
started();
shutdown();
  20         }
  22         // initialize .bss senment
  23         while (bss<&link_bss_end)
  24                 *bss++ = 0;
boot();
  27 }
  29 int screen_opened(void) {
  30         return (physw_status[2] & 0x00000200);
  31 }
  33 int screen_rotated(void) {
  34         return !(physw_status[2] & 0x00000100);
  35 }
  37 // Focus length table in firmware @ 0xfff4a7b4
  38 #define NUM_FL      201 // 0 - 200, entries in firmware
  39 #define NUM_DATA    1   // 1 int value each entry
  40 extern int focus_len_table[NUM_FL*NUM_DATA];
  42 // Conversion factor lens FL --> 35mm equiv
  43 // lens      35mm     CF
  44 // ----      ----     --
  45 // 4.3       24       ( 24/  4.3) * 43 = 240  (min FL)
  46 // 150.5     840      (840/150.5) * 43 = 240  (max FL)
  47 #define CF_EFL      240
  48 #define CF_EFL_DIV  43
  50 const int zoom_points = NUM_FL;
  52 int get_effective_focal_length(int zp) {
  53     return (CF_EFL*get_focal_length(zp))/CF_EFL_DIV;
  54 }
  56 int get_focal_length(int zp) {
  57     if (zp < 0) zp = 0;
  58     else if (zp >= NUM_FL) zp = NUM_FL-1;
  59     return focus_len_table[zp*NUM_DATA];
  60 }
  62 int get_zoom_x(int zp) {
  63     return get_focal_length(zp)*10/focus_len_table[0];
  64 }
  66 long get_vbatt_min()
  67 {
  68         return 6450;
  69 }
  71 long get_vbatt_max()
  72 {
  73         return 8300;
  74 }