root/platform/g12/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[0] & 0x80000000);
  31 }
  33 int screen_rotated(void) {
  34         return !(physw_status[0] & 0x40000000);
  35 }
  37 // Focus length table in firmware @0xfffe2a80
  38 #define NUM_FL      14  // 0 - 13, entries in firmware
  39 #define NUM_DATA    3   // 3 words each entry, first is FL
  40 extern int focus_len_table[NUM_FL*NUM_DATA];
  42 // Conversion factor lens FL --> 35mm equiv
  43 // lens      35mm     CF
  44 // ----      ----     --
  45 // 6.1       28       ( 28/ 6.1) * 61 = 280  (min FL)
  46 // 30.5      140      (140/30.5) * 61 = 280  (max FL)
  47 #define CF_EFL      280
  48 #define CF_EFL_DIV  61
  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 6500;
  69 }
  71 long get_vbatt_max()
  72 {
  73         return 8150;
  74 }