Subversion Repositories FlightCtrl

Rev

Rev 1926 | Rev 2099 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1910 - 1
#include <util/delay.h>
2
#include <avr/eeprom.h>
3
#include <stddef.h>
4
#include "configuration.h"
5
#include "eeprom.h"
6
#include "uart0.h"
7
 
8
int16_t variables[8] = {0,0,0,0,0,0,0,0};
1927 - 9
dynamicParam_t dynamicParams;// = {48,251,16,58,64,8,150,150,2,10,{0,0,0,0,0,0,0,0},100,70,90,65,64,100,0,0,0};
1910 - 10
uint8_t CPUType = ATMEGA644;
11
uint8_t BoardRelease = 13;
12
 
13
/************************************************************************
14
 * Map the parameter to pot values                                    
15
 * Replacing this code by the code below saved almost 1 kbyte.
16
 ************************************************************************/
17
 
18
void configuration_staticToDynamic(void) {
19
  uint8_t i;
20
#define SET_POT_MM(b,a,min,max) {if (a<255) {if (a>=251) b=variables[a-251]; else b=a;} if(b<=min) b=min; else if(b>=max) b=max;}
21
#define SET_POT(b,a) { if (a<255) {if (a>=251) b=variables[a-251]; else b=a;}}
22
  SET_POT(dynamicParams.MaxHeight,staticParams.MaxHeight);
23
  SET_POT_MM(dynamicParams.HeightD,staticParams.HeightD,0,100);
24
  SET_POT_MM(dynamicParams.HeightP,staticParams.HeightP,0,100);
25
    SET_POT(dynamicParams.CompassYawEffect,staticParams.CompassYawEffect);
26
 
27
  SET_POT(dynamicParams.GyroPitchP,staticParams.GyroPitchP);
28
  SET_POT(dynamicParams.GyroRollP,staticParams.GyroRollP);
29
  SET_POT(dynamicParams.GyroYawP,staticParams.GyroYawP);
30
 
31
  SET_POT(dynamicParams.GyroPitchD,staticParams.GyroPitchD);
32
  SET_POT(dynamicParams.GyroRollD,staticParams.GyroRollD);
33
  SET_POT(dynamicParams.GyroYawD,staticParams.GyroYawD);
34
 
1926 - 35
  for (i=0; i<sizeof(staticParams.UserParams); i++) {
36
    SET_POT(dynamicParams.UserParams[i],staticParams.UserParams[i]);
1910 - 37
  }
1927 - 38
 
1910 - 39
  SET_POT_MM(dynamicParams.J16Timing,staticParams.J16Timing,1,255);
40
  SET_POT_MM(dynamicParams.J17Timing,staticParams.J17Timing,1,255);
41
 
42
  SET_POT(dynamicParams.ExternalControl,staticParams.ExternalControl);
43
}
44
 
45
uint8_t getCPUType(void) {   // works only after reset or power on when the registers have default values
46
  uint8_t CPUType = ATMEGA644;
47
  //if( (UCSR1A == 0x20) && (UCSR1C == 0x06) ) CPUType = ATMEGA644P;  // initial Values for 644P after reset
48
  return CPUType;
49
}
50
 
51
/*
52
 * Automatic detection of hardware components is not supported in this development-oriented
53
 * FC firmware. It would go against the point of it: To enable alternative hardware
54
 * configurations with otherwise unsupported components. Instead, one should write
55
 * custom code + adjust constants for the new hardware, and include the relevant code
56
 * from the makefile.
57
 * However - we still do detect the board release. Reason: Otherwise it would be too
58
 * tedious to have to modify the code for how to turn on and off LEDs when deploying
59
 * on different HW version....
60
 */
61
 
62
uint8_t getBoardRelease(void) {
63
  uint8_t BoardRelease = 13;
64
  // the board release is coded via the pull up or down the 2 status LED
65
 
66
  PORTB &= ~((1 << PORTB1)|(1 << PORTB0)); // set tristate
67
  DDRB  &= ~((1 << DDB0)|(1 << DDB0)); // set port direction as input
68
 
69
  _delay_loop_2(1000); // make some delay
70
 
71
  switch( PINB & ((1<<PINB1)|(1<<PINB0))) {
72
    case 0x00:
73
      BoardRelease = 10; // 1.0
74
      break;
75
    case 0x01:
76
      BoardRelease = 11; // 1.1 or 1.2
77
      break;
78
    case 0x02:
79
      BoardRelease = 20; // 2.0
80
      break;
81
    case 0x03:
82
      BoardRelease = 13; // 1.3
83
      break;
84
    default:
85
      break;
86
    }
87
  // set LED ports as output
88
  DDRB |= (1<<DDB1)|(1<<DDB0);
89
  RED_ON;
90
  GRN_OFF;
91
  return BoardRelease;
92
}