{ //run in own scope for fast switch
const STORAGE = require("Storage");
const BAT_FULL = require("Storage").readJSON("setting.json").batFullVoltage || 0.3144;

let init = function(){
  global.screen = 1;
  global.drawTimeout = undefined;
  global.lastDrawnScreen = 0;
  global.firstDraw = true;
  global.slices = [];
  global.maxScreens = 1;
  global.scheduleDraw = false;

  Bangle.loadWidgets();
  WIDGETS.gpstrek.start(false);
  if (!WIDGETS.gpstrek.getState().numberOfSlices) WIDGETS.gpstrek.getState().numberOfSlices = 2;
};

let cleanup = function(){
  if (global.drawTimeout) clearTimeout(global.drawTimeout);
  delete global.screen;
  delete global.drawTimeout;
  delete global.lastDrawnScreen;
  delete global.firstDraw;
  delete global.slices;
  delete global.maxScreens;
};

let rotate = function(point, rotation, center){
  return {
    x: ((point.x - center.x) * Math.cos(rotation) - (point.y - center.y) * Math.sin(rotation)) + center.x,
    y: ((point.y - center.y) * Math.cos(rotation) + (point.x - center.x) * Math.sin(rotation)) + center.y
  };
};

init();
scheduleDraw = true;

let parseNumber = function(toParse){
  if (toParse.includes(".")) return parseFloat(toParse);
  return parseFloat("" + toParse + ".0");
};

let parseWaypoint = function(filename, offset, result){
  result.lat = parseNumber(STORAGE.read(filename, offset, 11));
  result.lon = parseNumber(STORAGE.read(filename, offset += 11, 12));
  return offset + 12;
};

let parseWaypointWithElevation = function (filename, offset, result){
  offset = parseWaypoint(filename, offset, result);
  result.alt = parseNumber(STORAGE.read(filename, offset, 6));
  return offset + 6;
};

let parseWaypointWithName = function(filename, offset, result){
  offset = parseWaypoint(filename, offset, result);
  return parseName(filename, offset, result);
};

let parseName = function(filename, offset, result){
  let nameLength = STORAGE.read(filename, offset, 2) - 0;
  result.name = STORAGE.read(filename, offset += 2, nameLength);
  return offset + nameLength;
};

let parseWaypointWithElevationAndName = function(filename, offset, result){
  offset = parseWaypointWithElevation(filename, offset, result);
  return parseName(filename, offset, result);
};

let getEntry = function(filename, offset, result){
  result.fileOffset = offset;
  let type = STORAGE.read(filename, offset++, 1);
  if (type == "") return -1;
  switch (type){
    case "A":
      offset = parseWaypoint(filename, offset, result);
      break;
    case "B":
      offset = parseWaypointWithName(filename, offset, result);
      break;
    case "C":
      offset = parseWaypointWithElevation(filename, offset, result);
      break;
    case "D":
      offset = parseWaypointWithElevationAndName(filename, offset, result);
      break;
    default:
      print("Unknown entry type", type);
      return -1;
  }
  offset++;

  result.fileLength = offset - result.fileOffset;
  return offset;
};

const labels = ["N","NE","E","SE","S","SW","W","NW"];
const loc = require("locale");

let matchFontSize = function(graphics, text, height, width){
  graphics.setFontVector(height);
  let metrics;
  let size = 1;
  while (graphics.stringMetrics(text).width > 0.90 * width){
    size -= 0.05;
    graphics.setFont("Vector",Math.floor(height*size));
  }
};

let getDoubleLineSlice = function(title1,title2,provider1,provider2){
  let lastValue1 = 0;
  let lastValue2 = 0;
  return {
    refresh: function (){
      let bigChange1 = (Math.abs(lastValue1 - provider1()) > 1);
      let bigChange2 = (Math.abs(lastValue2 - provider2()) > 1);
      return (bigChange1 || bigChange2);
    },
    draw: function (graphics, x, y, height, width){
      lastDrawn = Date.now();
      if (typeof title1 == "function") title1 = title1();
      if (typeof title2 == "function") title2 = title2();
      graphics.clearRect(x,y,x+width,y+height);

      lastValue1 = provider1();
      matchFontSize(graphics, title1 + lastValue1, Math.floor(height*0.5), width);
      graphics.setFontAlign(-1,-1);
      graphics.drawString(title1, x+2, y);
      graphics.setFontAlign(1,-1);
      graphics.drawString(lastValue1, x+width, y);

      lastValue2 = provider2();
      matchFontSize(graphics, title2 + lastValue2, Math.floor(height*0.5), width);
      graphics.setFontAlign(-1,-1);
      graphics.drawString(title2, x+2, y+(height*0.5));
      graphics.setFontAlign(1,-1);
      graphics.drawString(lastValue2, x+width, y+(height*0.5));
    }
  };
};

const arrow = Graphics.createImage(`
      X
    XXX
    XXXXX
  XXX XXX
  XXX   XXX
XXX     XXX
`);

const cross = Graphics.createImage(`
XX       XX
  XX     XX 
  XX   XX
    XX XX
    XXX
    XX XX
  XX   XX
  XX     XX
XX       XX
`);

const point = Graphics.createImage(`
    XXX
  XXXXXXX
XXX   XXX
XX     XX
XX     XX
XXX   XXX
  XXXXXXX
    XXX
`);

let getMapSlice = function(){
  return {
    draw: function (graphics, x, y, height, width){  
      graphics.clearRect(x,y,x+width,y+height);
      graphics.setClipRect(x,y,x+width,y+height);

      let course = WIDGETS.gpstrek.getState().currentPos.course;
      if  (course === undefined) course = WIDGETS.gpstrek.getState().avgComp;
      if  (course === undefined) course = 0;

      let route = WIDGETS.gpstrek.getState().route;
      let startingPoint = Bangle.project(route.currentWaypoint);
      let current = Bangle.project(WIDGETS.gpstrek.getState().currentPos);

      let compassHeight = height*0.4;
      if (compassHeight > g.getHeight()*0.1) compassHeight = g.getHeight()*0.1;
      let mapCenterX = x+(width-10)/2+compassHeight+5;

      let drawPath = function(iter, reverse){
        let poly=[ 0, 0 ];
        let i = 0;
        let maxViewableDistance = graphics.getHeight()/2/0.05;
        let named = [];
        do {
          i = i + (reverse?-1:1);
          let p = iter(route, route.index + i);
          if (!p || !p.lat) break;
          if (p.name) named.push({i:poly.length,n:p.name});
          let toDraw = Bangle.project(p);
          poly.push(startingPoint.x-toDraw.x);
          poly.push((startingPoint.y-toDraw.y)*-1);

          if (poly[poly.length - 2] < -maxViewableDistance
              || poly[poly.length - 2] > maxViewableDistance
              || poly[poly.length - 1] < -maxViewableDistance
              || poly[poly.length - 1] > maxViewableDistance) {
            break;
          }
        } while (i*(reverse?-1:1) < (reverse?10:50));

        poly = graphics.transformVertices(poly, {
          scale: 0.05,
          rotate:require("graphics_utils").degreesToRadians(180-course),
          x: mapCenterX,
          y: y+height*0.7
        });

        graphics.drawPoly(poly, false);
        graphics.setFont6x15();
        for (let c of named){
          graphics.drawImage(cross, poly[c.i]-5, poly[c.i+1]-4.5);
          graphics.drawString(c.n, poly[c.i] + 10, poly[c.i+1]);
        }
      };
      drawPath(getNext,false);
      drawPath(getPrev,true);

      graphics.setColor(graphics.theme.fg);

      if (WIDGETS.gpstrek.getState().currentPos.lat) {
        current.x = startingPoint.x - current.x;
        current.y = (startingPoint.y - current.y)*-1;
        current.x *= 0.05;
        current.y *= 0.05;
        current.x += mapCenterX;
        current.y += y + height*0.7;

        if (current.x < x) { current.x = x + height*0.15; graphics.setColor(1,0,0).fillRect(x,y,x+height*0.1,y+height);}
        if (current.x > x + width) {current.x = x + width - height*0.15; graphics.setColor(1,0,0).fillRect(x + width - height * 0.1,y,x + width ,y+height);}
        if (current.y < y) {current.y = y + height*0.15; graphics.setColor(1,0,0).fillRect(x,y,x + width,y+height*0.1);}
        if (current.y > y + height) { current.y = y + height - height*0.15; graphics.setColor(1,0,0).fillRect(x,y + height * 0.9,x + width ,y+height);}

        graphics.drawImage(arrow, current.x-5,current.y);
      } else {
        graphics.drawImage(point, mapCenterX-5,y + height*0.7-4);
      }

      let compass = [ 0,0, 0, compassHeight, 0, -compassHeight, compassHeight,0,-compassHeight,0 ];
      compass = graphics.transformVertices(compass, {
        rotate:require("graphics_utils").degreesToRadians(180-course),
        x: x + 5 + compassHeight,
        y: y + 5 + compassHeight
      });
      graphics.setFontAlign(0,0);
      graphics.setColor(graphics.theme.bg);
      graphics.fillCircle(x+5+compassHeight,y+5+compassHeight,compassHeight+8);
      graphics.setColor(graphics.theme.fg);
      graphics.drawCircle(x+5+compassHeight,y+5+compassHeight,compassHeight);
      graphics.drawString("N", compass[2], compass[3], true);
      graphics.drawString("S", compass[4], compass[5], true);
      graphics.drawString("W", compass[6], compass[7], true);
      graphics.drawString("E", compass[8], compass[9], true);
    }
  };
};

let getTargetSlice = function(targetDataSource){
  let nameIndex = 0;
  return {
    draw: function (graphics, x, y, height, width){
      graphics.clearRect(x,y,x+width,y+height);
      if (targetDataSource.icon){
        graphics.drawImage(targetDataSource.icon,x,y + (height - 16)/2);
        x += 16;
        width -= 16;
      }

      let start = targetDataSource.getStart();
      let target = targetDataSource.getTarget();

      if (!target || !start) return;

      let dist = distance(start,target);
      if (isNaN(dist)) dist = Infinity;
      let bearingString = bearing(start,target) + "°";
      if (target.name) {
        graphics.setFont("Vector",Math.floor(height*0.5));
        let scrolledName = (target.name || "").substring(nameIndex);
        if (graphics.stringMetrics(scrolledName).width > width){
          nameIndex++;
        } else {
          nameIndex = 0;
        }
        graphics.drawString(scrolledName, x+2, y);

        let distanceString = loc.distance(dist,2);
        matchFontSize(graphics, distanceString + bearingString, height*0.5, width);
        graphics.drawString(bearingString, x+2, y+(height*0.5));
        graphics.setFontAlign(1,-1);
        graphics.drawString(distanceString, x + width, y+(height*0.5));
      } else {
        graphics.setFont("Vector",Math.floor(height*1));
        let bearingString = bearing(start,target) + "°";
        let formattedDist = loc.distance(dist,2);
        let distNum = (formattedDist.match(/[0-9\.]+/) || [Infinity])[0];
        let size = 0.8;
        let distNumMetrics;
        while (graphics.stringMetrics(bearingString).width + (distNumMetrics = graphics.stringMetrics(distNum)).width > 0.90 * width){
          size -= 0.05;
          graphics.setFont("Vector",Math.floor(height*size));
        }
        graphics.drawString(bearingString, x+2, y + (height - distNumMetrics.height)/2);
        graphics.setFontAlign(1,-1);
        graphics.drawString(distNum, x + width, y + (height - distNumMetrics.height)/2);
        graphics.setFont("Vector",Math.floor(height*0.25));

        graphics.setFontAlign(-1,1);
        if (targetDataSource.getProgress){
          graphics.drawString(targetDataSource.getProgress(), x + 2, y + height);
        }
        graphics.setFontAlign(1,1);
        if (!isNaN(distNum) && distNum != Infinity)
          graphics.drawString(formattedDist.match(/[a-zA-Z]+/), x + width, y + height);
      }
    }
  };
};

let drawCompass = function(graphics, x, y, height, width, increment, start){
  graphics.setFont12x20();
  graphics.setFontAlign(0,-1);
  graphics.setColor(graphics.theme.fg);
  let frag = 0 - start%15;
  if (frag>0) frag = 0;
  let xpos = 0 + frag*increment;
  for (let i=start;i<=720;i+=15){
    var res = i + frag;
    if (res%90==0) {
      graphics.drawString(labels[Math.floor(res/45)%8],xpos,y+2);
      graphics.fillRect(xpos-2,Math.floor(y+height*0.6),xpos+2,Math.floor(y+height));
    } else if (res%45==0) {
      graphics.drawString(labels[Math.floor(res/45)%8],xpos,y+2);
      graphics.fillRect(xpos-2,Math.floor(y+height*0.75),xpos+2,Math.floor(y+height));
    } else if (res%15==0) {
      graphics.fillRect(xpos,Math.floor(y+height*0.9),xpos+1,Math.floor(y+height));
    }
    xpos+=increment*15;
    if (xpos > width + 20) break;
  }
};

let getCompassSlice = function(compassDataSource){
  let lastDrawnValue = 0;
  const buffers = 4;
  let buf = [];
  return {
    refresh : function (){
      return (Math.abs(lastDrawnValue - compassDataSource.getCourse()) > 2);
    },
    draw: function (graphics, x,y,height,width){
      lastDrawn = Date.now();
      const max = 180;
      const increment=width/max;

      graphics.clearRect(x,y,x+width,y+height);

      lastDrawnValue = compassDataSource.getCourse();

      var start = lastDrawnValue - 90;
      if (isNaN(lastDrawnValue)) start = -90;
      if (start<0) start+=360;
      start = start % 360;

      if (WIDGETS.gpstrek.getState().acc && compassDataSource.getCourseType() == "MAG"){
        drawCompass(graphics,0,y+width*0.05,height-width*0.05,width,increment,start);
      } else {
        drawCompass(graphics,0,y,height,width,increment,start);
      }


      if (compassDataSource.getPoints){
        let points = compassDataSource.getPoints(); //storing this in a variable works around a minifier bug causing a problem in the next line: for(let a of a.getPoints())
        for (let p of points){
          g.reset();
          var bpos = p.bearing - lastDrawnValue;
          if (bpos>180) bpos -=360;
          if (bpos<-180) bpos +=360;
          bpos+=120;
          let min = 0;
          let max = 180;
          if (bpos<=min){
            bpos = Math.floor(width*0.05);
          } else if (bpos>=max) {
            bpos = Math.ceil(width*0.95);
          } else {
            bpos=Math.round(bpos*increment);
          }
          if (p.color){
            graphics.setColor(p.color);
          }
          if (p.icon){
            graphics.drawImage(p.icon, bpos,y+height-12, {rotate:0,scale:2});
          } else {
            graphics.fillCircle(bpos,y+height-12,Math.floor(width*0.03));
          }
        }
      }
      if (compassDataSource.getMarkers){
        let markers = compassDataSource.getMarkers(); //storing this in a variable works around a minifier bug causing a problem in the next line: for(let a of a.getMarkers())
        for (let m of markers){
          g.reset();
          g.setColor(m.fillcolor);
          let mpos = m.xpos * width;
          if (m.xpos < 0.05) mpos = Math.floor(width*0.05);
          if (m.xpos > 0.95) mpos = Math.ceil(width*0.95);
          g.fillPoly(triangle(mpos,y+height-m.height, m.height, m.width));
          g.setColor(m.linecolor);
          g.drawPoly(triangle(mpos,y+height-m.height, m.height, m.width),true);
        }
      }
      graphics.setColor(g.theme.fg);
      graphics.fillRect(x,y,Math.floor(width*0.05),y+height);
      graphics.fillRect(Math.ceil(width*0.95),y,width,y+height);
      if (WIDGETS.gpstrek.getState().acc && compassDataSource.getCourseType() == "MAG") {
        let xh = E.clip(width*0.5-height/2+(((WIDGETS.gpstrek.getState().acc.x+1)/2)*height),width*0.5 - height/2, width*0.5 + height/2);
        let yh = E.clip(y+(((WIDGETS.gpstrek.getState().acc.y+1)/2)*height),y,y+height);

        graphics.fillRect(width*0.5 - height/2, y, width*0.5 + height/2, y + Math.floor(width*0.05));

        graphics.setColor(g.theme.bg);
        graphics.drawLine(width*0.5 - 5, y, width*0.5 - 5, y + Math.floor(width*0.05));
        graphics.drawLine(width*0.5 + 5, y, width*0.5 + 5, y + Math.floor(width*0.05));
        graphics.fillRect(xh-1,y,xh+1,y+Math.floor(width*0.05));

        let left = Math.floor(width*0.05);
        let right = Math.ceil(width*0.95);
        graphics.drawLine(0,y+height/2-5,left,y+height/2-5);
        graphics.drawLine(right,y+height/2-5,x+width,y+height/2-5);
        graphics.drawLine(0,y+height/2+5,left,y+height/2+5);
        graphics.drawLine(right,y+height/2+5,x+width,y+height/2+5);
        graphics.fillRect(0,yh-1,left,yh+1);
        graphics.fillRect(right,yh-1,x+width,yh+1);
      }
      graphics.setColor(g.theme.fg);
      graphics.drawRect(Math.floor(width*0.05),y,Math.ceil(width*0.95),y+height);
    }
  };
};

let radians = function(a) {
  return a*Math.PI/180;
};

let degrees = function(a) {
  let d = a*180/Math.PI;
  return (d+360)%360;
};

let bearing = function(a,b){
  if (!a || !b || !a.lon || !a.lat || !b.lon || !b.lat) return Infinity;
  let delta = radians(b.lon-a.lon);
  let alat = radians(a.lat);
  let blat = radians(b.lat);
  let y = Math.sin(delta) * Math.cos(blat);
  let x = Math.cos(alat)*Math.sin(blat) -
        Math.sin(alat)*Math.cos(blat)*Math.cos(delta);
  return Math.round(degrees(Math.atan2(y, x)));
};

let distance = function(a,b){
  if (!a || !b || !a.lon || !a.lat || !b.lon || !b.lat) return Infinity;
  let x = radians(a.lon-b.lon) * Math.cos(radians((a.lat+b.lat)/2));
  let y = radians(b.lat-a.lat);
  return Math.round(Math.sqrt(x*x + y*y) * 6371000);
};

let getAveragedCompass = function(){
  return Math.round(WIDGETS.gpstrek.getState().avgComp);
};

let triangle = function(x, y, width, height){
  return  [
    Math.round(x),Math.round(y),
    Math.round(x+width * 0.5), Math.round(y+height),
    Math.round(x-width * 0.5), Math.round(y+height)
  ];
};

let onSwipe = function(dir){
  if (dir < 0) {
    nextScreen();
  } else if (dir > 0) {
    switchMenu();
  } else {
    nextScreen();
  }
};

let setButtons = function(){
  let options = {
    mode: "custom",
    swipe: onSwipe,
    btn: nextScreen,
    touch: nextScreen
  };
  Bangle.setUI(options);
};

let getApproxFileSize = function(name){
  let currentStart = STORAGE.getStats().totalBytes;
  let currentSize = 0;
  for (let i = currentStart; i > 500; i/=2){
    let currentDiff = i;
    //print("Searching", currentDiff);
    while (STORAGE.read(name, currentSize+currentDiff, 1) == ""){
      //print("Loop", currentDiff);
      currentDiff = Math.ceil(currentDiff/2);
    }
    i = currentDiff*2;
    currentSize += currentDiff;
  }
  return currentSize;
};

let parseRouteData = function(filename, progressMonitor){
  let routeInfo = {};

  routeInfo.filename = filename;
  routeInfo.refs = [];

  let c = {};
  let scanOffset = 0;
  routeInfo.length = 0;
  routeInfo.count = 0;
  routeInfo.mirror = false;
  let lastSeenWaypoint;
  let lastSeenAlt;
  let waypoint = {};

  routeInfo.up = 0;
  routeInfo.down = 0;

  let size = getApproxFileSize(filename);

  while ((scanOffset = getEntry(filename, scanOffset, waypoint)) > 0) {
    if (routeInfo.count % 5 == 0) progressMonitor(scanOffset, "Loading", size);
    if (lastSeenWaypoint){
      routeInfo.length += distance(lastSeenWaypoint, waypoint);

      let diff = waypoint.alt - lastSeenAlt;
      //print("Distance", routeInfo.length, "alt", lastSeenAlt, waypoint.alt, diff);   
      if (waypoint.alt && lastSeenAlt && diff > 3){
        if (lastSeenAlt < waypoint.alt){
          //print("Up", diff);
          routeInfo.up += diff;
        } else {
          //print("Down", diff);
          routeInfo.down += diff;
        }
      }
    }
    routeInfo.count++;
    routeInfo.refs.push(waypoint.fileOffset);
    lastSeenWaypoint = waypoint;
    if (!isNaN(waypoint.alt)) lastSeenAlt = waypoint.alt;
    waypoint = {};
  }

  set(routeInfo, 0);
  return routeInfo;
};

let hasPrev = function(route, index){
  if (!index) index = route.index;
  if (route.mirror) return route.index < (route.count - 1);
  return route.index > 0;
};

let hasNext = function(route, index){
  if (!index) index = route.index;
  if (route.mirror) return route.index > 0;
  return index < (route.count - 1);
};

let getNext = function(route, index){
  if (!index) index = route.index;
  if (!hasNext(route, index)) return;
  if (route.mirror) --index;
  if (!route.mirror) ++index;
  let result = {};
  getEntry(route.filename, route.refs[index], result);
  return result;
};

let getPrev = function(route, index){
  if (!index) index = route.index;
  if (!hasPrev(route, index)) return;
  if (route.mirror) ++index;
  if (!route.mirror) --index;
  let result = {};
  getEntry(route.filename, route.refs[index], result);
  return result;
};

let next = function(route){
  if (!hasNext(route)) return;
  if (route.mirror) set(route, --route.index);
  if (!route.mirror) set(route, ++route.index);
};

let set = function(route, index){
  if (!route) return;
  route.currentWaypoint = {};
  route.index = index;
  getEntry(route.filename, route.refs[index], route.currentWaypoint);
};

let prev = function(route){
  if (!hasPrev(route)) return;
  if (route.mirror) set(route, ++route.index);
  if (!route.mirror) set(route, --route.index);
};

let lastMirror;
let cachedLast;

let getLast = function(route){
  let wp = {};
  if (lastMirror != route.mirror){
    if (route.mirror) getEntry(route.filename, route.refs[0], wp);
    if (!route.mirror) getEntry(route.filename, route.refs[route.count - 1], wp);
    lastMirror = route.mirror;
    cachedLast = wp;
  }
  return cachedLast;
};

let removeMenu = function(){
  E.showMenu();
  switchNav();
};

let showProgress = function(progress, title, max){
  //print("Progress",progress,max)
  let message = title? title: "Loading";
  if (max){
    message += " " + E.clip((progress/max*100),0,100).toFixed(0) +"%";
  } else {
    let dots = progress % 4;
    for (let i = 0; i < dots; i++) message += ".";
    for (let i = dots; i < 4; i++) message += " ";
  }
  E.showMessage(message);
};

let handleLoading = function(c){
  E.showMenu();
  WIDGETS.gpstrek.getState().route = parseRouteData(c, showProgress);
  WIDGETS.gpstrek.getState().waypoint = null;
  WIDGETS.gpstrek.getState().route.mirror = false;
  removeMenu();
};

let showRouteSelector  = function(){
  var menu = {
    "" : {
      back : showRouteMenu,
    }
  };

  STORAGE.list(/\.trf$/).forEach((file)=>{
      menu[file] = ()=>{handleLoading(file);};
  });

  E.showMenu(menu);
};

let showRouteMenu = function(){
  var menu = {
    "" : {
      "title" : "Route",
      back : showMenu,
    },
    "Select file" : showRouteSelector
  };

  if (WIDGETS.gpstrek.getState().route){
    menu.Mirror = {
      value: WIDGETS.gpstrek.getState() && WIDGETS.gpstrek.getState().route && !!WIDGETS.gpstrek.getState().route.mirror || false,
      onchange: v=>{
        WIDGETS.gpstrek.getState().route.mirror = v;
      }
    };
    menu['Select closest waypoint'] = function () {
      if (WIDGETS.gpstrek.getState().currentPos && WIDGETS.gpstrek.getState().currentPos.lat){
        setClosestWaypoint(WIDGETS.gpstrek.getState().route, null, showProgress); removeMenu();
      } else {
        E.showAlert("No position").then(()=>{E.showMenu(menu);});
      }
    };
    menu['Select closest waypoint (not visited)'] = function () {
      if (WIDGETS.gpstrek.getState().currentPos && WIDGETS.gpstrek.getState().currentPos.lat){
        setClosestWaypoint(WIDGETS.gpstrek.getState().route, WIDGETS.gpstrek.getState().route.index, showProgress); removeMenu();
      } else {
        E.showAlert("No position").then(()=>{E.showMenu(menu);});
      }
    };
    menu['Select waypoint'] = {
      value : WIDGETS.gpstrek.getState().route.index,
      min:1,max:WIDGETS.gpstrek.getState().route.count,step:1,
      onchange : v => { set(WIDGETS.gpstrek.getState().route, v-1); }
    };
    menu['Select waypoint as current position'] = function (){
      WIDGETS.gpstrek.getState().currentPos.lat = WIDGETS.gpstrek.getState().route.currentWaypoint.lat;
      WIDGETS.gpstrek.getState().currentPos.lon = WIDGETS.gpstrek.getState().route.currentWaypoint.lon;
      WIDGETS.gpstrek.getState().currentPos.alt = WIDGETS.gpstrek.getState().route.currentWaypoint.alt;
      removeMenu();
    };
  }

  if (WIDGETS.gpstrek.getState().route && hasPrev(WIDGETS.gpstrek.getState().route))
    menu['Previous waypoint'] = function() { prev(WIDGETS.gpstrek.getState().route); removeMenu(); };
  if (WIDGETS.gpstrek.getState().route && hasNext(WIDGETS.gpstrek.getState().route))
    menu['Next waypoint'] = function() { next(WIDGETS.gpstrek.getState().route); removeMenu(); };
  E.showMenu(menu);
};

let showWaypointSelector = function(){
  let waypoints = require("waypoints").load();
  var menu = {
    "" : {
      back : showWaypointMenu,
    }
  };

  waypoints.forEach((wp,c)=>{
    menu[waypoints[c].name] = function (){
      WIDGETS.gpstrek.getState().waypoint = waypoints[c];
      WIDGETS.gpstrek.getState().waypointIndex = c;
      WIDGETS.gpstrek.getState().route = null;
      removeMenu();
    };
  });

  E.showMenu(menu);
};

let showCalibrationMenu = function(){
  let menu = {
    "" : {
      "title" : "Calibration",
      back : showMenu,
    },
    "Barometer (GPS)" : ()=>{
      if (!WIDGETS.gpstrek.getState().currentPos || isNaN(WIDGETS.gpstrek.getState().currentPos.alt)){
        E.showAlert("No GPS altitude").then(()=>{E.showMenu(menu);});
      } else {
        WIDGETS.gpstrek.getState().calibAltDiff = WIDGETS.gpstrek.getState().altitude - WIDGETS.gpstrek.getState().currentPos.alt;
        E.showAlert("Calibrated Altitude Difference: " + WIDGETS.gpstrek.getState().calibAltDiff.toFixed(0)).then(()=>{removeMenu();});
      }
    },
    "Barometer (Manual)" : {
      value : Math.round(WIDGETS.gpstrek.getState().currentPos && (WIDGETS.gpstrek.getState().currentPos.alt != undefined && !isNaN(WIDGETS.gpstrek.getState().currentPos.alt)) ? WIDGETS.gpstrek.getState().currentPos.alt: WIDGETS.gpstrek.getState().altitude),
      min:-2000,max: 10000,step:1,
      onchange : v => { WIDGETS.gpstrek.getState().calibAltDiff = WIDGETS.gpstrek.getState().altitude - v; }
    },
    "Reset Compass" : ()=>{ Bangle.resetCompass(); removeMenu();},
  };
  E.showMenu(menu);
};

let showWaypointMenu = function(){
  let menu = {
    "" : {
      "title" : "Waypoint",
      back : showMenu,
    },
    "Select waypoint" : showWaypointSelector,
  };
  E.showMenu(menu);
};

let showBackgroundMenu = function(){
  let menu = {
    "" : {
      "title" : "Background",
      back : showMenu,
    },
    "Start" : ()=>{ E.showPrompt("Start?").then((v)=>{ if (v) {WIDGETS.gpstrek.start(true); removeMenu();} else {showMenu();}}).catch(()=>{showMenu();});},
    "Stop" : ()=>{ E.showPrompt("Stop?").then((v)=>{ if (v) {WIDGETS.gpstrek.stop(true); removeMenu();} else {showMenu();}}).catch(()=>{showMenu();});},
  };
  E.showMenu(menu);
};

let showMenu = function(){
  var mainmenu = {
    "" : {
      "title" : "Main",
      back : removeMenu,
    },
    "Route" : showRouteMenu,
    "Waypoint" : showWaypointMenu,
    "Background" : showBackgroundMenu,
    "Calibration": showCalibrationMenu,
    "Reset" : ()=>{ E.showPrompt("Do Reset?").then((v)=>{ if (v) {WIDGETS.gpstrek.resetState(); removeMenu();} else {E.showMenu(mainmenu);}}).catch(()=>{E.showMenu(mainmenu);});},
    "Info rows" : {
      value : WIDGETS.gpstrek.getState().numberOfSlices,
      min:1,max:6,step:1,
      onchange : v => { WIDGETS.gpstrek.getState().numberOfSlices = v; }
    },
  };

  E.showMenu(mainmenu);
};


let switchMenu = function(){
  stopDrawing();
  showMenu();
};

let stopDrawing = function(){
  if (drawTimeout) clearTimeout(drawTimeout);
  scheduleDraw = false;
};

let drawInTimeout = function(){
  if (global.drawTimeout) clearTimeout(drawTimeout);
  drawTimeout = setTimeout(()=>{
    drawTimeout = undefined;
    draw();
  },250);
};

let switchNav = function(){
  if (!screen) screen = 1;
  setButtons();
  scheduleDraw = true;
  firstDraw = true;
  drawInTimeout();
};

let nextScreen = function(){
  screen++;
  if (screen > maxScreens){
    screen = 1;
  }
  drawInTimeout();
};

let setClosestWaypoint = function(route, startindex, progress){
  if (startindex >= WIDGETS.gpstrek.getState().route.count) startindex = WIDGETS.gpstrek.getState().route.count - 1;
  if (!WIDGETS.gpstrek.getState().currentPos.lat){
    set(route, startindex);
    return;
  }
  let minDist = 100000000000000;
  let minIndex = 0;
  for (let i = startindex?startindex:0; i < route.count - 1; i++){
    if (progress && (i % 5 == 0)) progress(i-(startindex?startindex:0), "Searching", route.count);
    let wp = {};
    getEntry(route.filename, route.refs[i], wp);
    let curDist = distance(WIDGETS.gpstrek.getState().currentPos, wp);
    if (curDist < minDist){
      minDist = curDist;
      minIndex = i;
    } else {
      if (startindex) break;
    }
  }
  set(route, minIndex);
};

const finishIcon = atob("CggB//meZmeZ+Z5n/w==");

const compassSliceData = {
  getCourseType: function(){
    return (WIDGETS.gpstrek.getState().currentPos && WIDGETS.gpstrek.getState().currentPos.course) ? "GPS" : "MAG";
  },
  getCourse: function (){
    if(compassSliceData.getCourseType() == "GPS") return WIDGETS.gpstrek.getState().currentPos.course;
    return getAveragedCompass();
  },
  getPoints: function (){
    let points = [];
    let s = WIDGETS.gpstrek.getState();
    if (s.currentPos && s.currentPos.lon && s.route){
      points.push({bearing:bearing(s.currentPos, getLast(s.route)), icon: finishIcon});
    }
    if (s.currentPos && s.currentPos.lon && s.waypoint){
      points.push({bearing:bearing(s.currentPos, s.waypoint), icon: finishIcon});
    }
    if (s.currentPos && s.currentPos.lon && s.route && s.route.currentWaypoint){
      points.push({bearing:bearing(s.currentPos, s.route.currentWaypoint), color:"#0f0"});
    }
    return points;
  },
  getMarkers: function (){
    return [{xpos:0.5, width:10, height:10, linecolor:g.theme.fg, fillcolor:"#f00"}];
  }
};

const waypointData = {
  icon: atob("EBCBAAAAAAAAAAAAcIB+zg/uAe4AwACAAAAAAAAAAAAAAAAA"),
  getProgress: function() {
    return (WIDGETS.gpstrek.getState().route.index + 1) + "/" + WIDGETS.gpstrek.getState().route.count;
  },
  getTarget: function (){
    return WIDGETS.gpstrek.getState().route.currentWaypoint;
  },
  getStart: function (){
    return WIDGETS.gpstrek.getState().currentPos;
  }
};

const finishData = {
  icon: atob("EBABAAA/4DmgJmAmYDmgOaAmYD/gMAAwADAAMAAwAAAAAAA="),
  getTarget: function (){
    let s = WIDGETS.gpstrek.getState();
    if (s.route) return getLast(s.route);
    if (s.waypoint) return s.waypoint;
  },
  getStart: function (){
    return WIDGETS.gpstrek.getState().currentPos;
  }
};

let getSliceHeight = function(number){
  return Math.floor(Bangle.appRect.h/WIDGETS.gpstrek.getState().numberOfSlices);
};

let compassSlice = getCompassSlice(compassSliceData);
let mapSlice = getMapSlice();
let waypointSlice = getTargetSlice(waypointData);
let finishSlice = getTargetSlice(finishData);
let eleSlice = getDoubleLineSlice("Up","Down",()=>{
  let s = WIDGETS.gpstrek.getState();
  return loc.distance(s.up,3) + "/" + (s.route ? loc.distance(s.route.up,3):"---");
},()=>{
  let s = WIDGETS.gpstrek.getState();
  return loc.distance(s.down,3) + "/" + (s.route ? loc.distance(s.route.down,3): "---");
});

let statusSlice = getDoubleLineSlice("Speed","Alt",()=>{
  let speed = 0;
  let s = WIDGETS.gpstrek.getState();
  if (s.currentPos && s.currentPos.speed) speed = s.currentPos.speed;
  return loc.speed(speed,2);
},()=>{
  let alt = Infinity;
  let s = WIDGETS.gpstrek.getState();
  if (!isNaN(s.altitude)){
    alt = isNaN(s.calibAltDiff) ? s.altitude : (s.altitude - s.calibAltDiff);
  }
  if (s.currentPos && s.currentPos.alt) alt = s.currentPos.alt;
  if (isNaN(alt)) return "---";
  return loc.distance(alt,3);
});

let status2Slice = getDoubleLineSlice("Compass","GPS",()=>{
  return getAveragedCompass() + "°";
},()=>{
  let course = "---°";
  let s = WIDGETS.gpstrek.getState();
  if (s.currentPos && s.currentPos.course) course = s.currentPos.course + "°";
  return course;
});

let healthSlice = getDoubleLineSlice("Heart","Steps",()=>{
  return WIDGETS.gpstrek.getState().bpm || "---";
},()=>{
  return !isNaN(WIDGETS.gpstrek.getState().steps)? WIDGETS.gpstrek.getState().steps: "---";
});

let system2Slice = getDoubleLineSlice("Bat","",()=>{
  return (Bangle.isCharging()?"+":"") + E.getBattery().toFixed(0)+"% " + (analogRead(D3)*4.2/BAT_FULL).toFixed(2) + "V";
},()=>{
  return "";
});

let systemSlice = getDoubleLineSlice("RAM","Storage",()=>{
  let ram = process.memory(false);
  return ((ram.blocksize * ram.free)/1024).toFixed(0)+"kB";
},()=>{
  return (STORAGE.getFree()/1024).toFixed(0)+"kB";
});

let updateSlices = function(){
  let s = WIDGETS.gpstrek.getState();
  slices = [];
  slices.push(compassSlice);

  if (s.route) slices.push(mapSlice);
  if (s.currentPos && s.currentPos.lat && s.route && s.route.currentWaypoint && s.route.index < s.route.count - 1) {
    slices.push(waypointSlice);
  }
  if (s.currentPos && s.currentPos.lat && (s.route || s.waypoint)) {
    slices.push(finishSlice);
  }
  if ((s.route && s.route.down !== undefined) || s.down != undefined) {
    slices.push(eleSlice);
  }
  slices.push(statusSlice);
  slices.push(status2Slice);
  slices.push(healthSlice);
  slices.push(systemSlice);
  slices.push(system2Slice);
  maxScreens = Math.ceil(slices.length/s.numberOfSlices);
};

let clear = function() {
  g.clearRect(Bangle.appRect);
};

let minimumDistance = Number.MAX_VALUE;
let lastSearch = 0;

let updateRouting = function() {
  let s = WIDGETS.gpstrek.getState();
  if (s.route && s.currentPos.lat) {
    let currentDistanceToTarget = distance(s.currentPos,s.route.currentWaypoint);
    if (currentDistanceToTarget < minimumDistance){
      minimumDistance = currentDistanceToTarget;
    }
    let nextAvailable = hasNext(s.route);
    if (currentDistanceToTarget < 30 && nextAvailable){
      next(s.route);
      minimumDistance = Number.MAX_VALUE;
    } else if (lastSearch + 15000 < Date.now() && minimumDistance < currentDistanceToTarget - 30){
      stopDrawing();
      Bangle.buzz(1000);
      setClosestWaypoint(s.route, s.route.index, showProgress);
      minimumDistance = Number.MAX_VALUE;
      lastSearch = Date.now();
      switchNav();
    }
  }
};

let draw = function(){
  if (!global.screen) return;
  let ypos = Bangle.appRect.y;
  let s = WIDGETS.gpstrek.getState();

  let firstSlice = (screen-1)*s.numberOfSlices;

  updateSlices();

  let force = lastDrawnScreen != screen || firstDraw;
  if (force){
    clear();
  }
  if (firstDraw) Bangle.drawWidgets();
  lastDrawnScreen = screen;

  let sliceHeight = getSliceHeight();
  for (let slice of slices.slice(firstSlice,firstSlice + s.numberOfSlices)) {
    g.reset();
    if (!slice.refresh || slice.refresh() || force) slice.draw(g,0,ypos,sliceHeight,g.getWidth());
    ypos += sliceHeight+1;
    g.drawLine(0,ypos-1,g.getWidth(),ypos-1);
  }

  updateRouting();
  if (scheduleDraw){
    drawInTimeout();
  }
  firstDraw = false;
};


switchNav();

clear();
}