You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
134 lines
3.1 KiB
134 lines
3.1 KiB
#include <LiquidCrystal_I2C.h>
|
|
#include <stdio.h>
|
|
#include "Arduino.h"
|
|
#include "FrSkyD_cc2500.h"
|
|
#include "state.h"
|
|
#include "input.h"
|
|
#include "eeprom.h"
|
|
#include "debug.h"
|
|
#include "tx_def.h"
|
|
|
|
LCD_state_joy_calibration::LCD_state_joy_calibration(void) {
|
|
|
|
}
|
|
void LCD_state_joy_calibration::enter(void) {
|
|
lcd.setCursor(0,0);
|
|
lcd.print("calib. start ");
|
|
lcd.setCursor(0,1);
|
|
lcd.print("move all sticks ");
|
|
delay(500);
|
|
}
|
|
void show_dots(int row, int number) {
|
|
lcd.setCursor(0,row);
|
|
for(int c = 0; c < 16;++c) {
|
|
if (c < number)
|
|
lcd.print(".");
|
|
else
|
|
lcd.print(" ");
|
|
}
|
|
}
|
|
void LCD_state_joy_calibration::update(void) {
|
|
int8_t turns = 50;
|
|
int8_t i;
|
|
|
|
// init min/max
|
|
input.calibration_reset();
|
|
|
|
// min max calibration
|
|
lcd.setCursor(0,0);
|
|
lcd.print("min max Calib. ");
|
|
show_dots(1,16);
|
|
i = turns;
|
|
while(i > 0) {
|
|
input.update();
|
|
if (true == input.calibration_update()) {
|
|
i = turns;
|
|
}else {
|
|
i -= 1;
|
|
show_dots(1,(i *16)/turns);
|
|
}
|
|
delay(100);
|
|
}
|
|
|
|
// center
|
|
lcd.setCursor(0,0);
|
|
lcd.print("center sticks ");
|
|
i = turns;
|
|
while(i > 0) {
|
|
input.update();
|
|
if (false == input.is_centered()) {
|
|
i = turns;
|
|
}else {
|
|
i -= 1;
|
|
show_dots(1,(i *16)/turns);
|
|
}
|
|
delay(100);
|
|
}
|
|
|
|
for (uint8_t _ch = 0; _ch < 4 ; ++_ch) {
|
|
enum Input::input_channels ch = (enum Input::input_channels) _ch;
|
|
lcd.setCursor(0,0);
|
|
lcd.print("move to max: ");
|
|
lcd.setCursor(0,1);
|
|
lcd.print(" ");
|
|
lcd.setCursor(0,1);
|
|
lcd.print(ch_name[ch]);
|
|
|
|
i = turns;
|
|
while(i>0) {
|
|
delay(50);
|
|
input.update();
|
|
|
|
input.print_ch(ch);
|
|
if (input.is_high(ch)) {
|
|
i--;
|
|
continue;
|
|
}
|
|
|
|
if (input.is_low(ch)) {
|
|
input.invert_ch(ch);
|
|
debug("invert");
|
|
i = turns;
|
|
continue;
|
|
}
|
|
}
|
|
}
|
|
|
|
struct Input::ch_config ch_config[Input::CH_COUNT];
|
|
input.get_calibration(ch_config);
|
|
eeprom_config.set_ch_config(ch_config);
|
|
uint32_t id=0;
|
|
#ifdef FORCE_GLOBAL_ID
|
|
id = FORCE_GLOBAL_ID;
|
|
#else
|
|
// Generate a random ID from UUID
|
|
#define STM32_UUID ((uint32_t *)0x1FFFF7E8)
|
|
id = STM32_UUID[0] ^ STM32_UUID[1] ^ STM32_UUID[2];
|
|
#endif
|
|
debugln("Generated new master ID %lx", id);
|
|
eeprom_config.set_master_id(id);
|
|
eeprom_config.write();
|
|
|
|
eeprom_config.read();
|
|
if (eeprom_config.validate()) {
|
|
debugln("ok calib\n");
|
|
}else {
|
|
debugln("failed calib\n");
|
|
}
|
|
|
|
|
|
lcd.setCursor(0,0);
|
|
lcd.print("center again ");
|
|
lcd.setCursor(0,1);
|
|
lcd.print("all sticks ");
|
|
while (false == input.is_centered()) {
|
|
input.update();
|
|
}
|
|
new_state = s_menu;
|
|
}
|
|
void LCD_state_joy_calibration::leave(void) {
|
|
lcd.setCursor(0,0);
|
|
lcd.print("finished ");
|
|
lcd.setCursor(0,1);
|
|
lcd.print("calibration");
|
|
}
|