From a3fe614d3ab2d121bcf8b885fa43e1f7eba72202 Mon Sep 17 00:00:00 2001 From: Lennart Eriksson Date: Fri, 14 Oct 2016 14:33:15 +0200 Subject: [PATCH 1/4] temp change on eeprom --- UAV-ControlSystem/inc/config/eeprom.h | 10 ++++- UAV-ControlSystem/src/config/cli.c | 61 +++++++++++++++++++++++++-- UAV-ControlSystem/src/config/eeprom.c | 54 ++++++++++++++++++++++-- 3 files changed, 116 insertions(+), 9 deletions(-) diff --git a/UAV-ControlSystem/inc/config/eeprom.h b/UAV-ControlSystem/inc/config/eeprom.h index 1af16b4..d2f774d 100644 --- a/UAV-ControlSystem/inc/config/eeprom.h +++ b/UAV-ControlSystem/inc/config/eeprom.h @@ -194,7 +194,15 @@ typedef enum { /* List of all profile EEPROM values */ typedef enum { - EEPROM_PID_ROLL_KP = 0, + EEPROM_PID_GYRO_P_ROLL, + EEPROM_PID_GYRO_P_PITCH, + EEPROM_PID_GYRO_P_YAW, + EEPROM_PID_GYRO_I_ROLL, + EEPROM_PID_GYRO_I_PITCH, + EEPROM_PID_GYRO_I_YAW, + EEPROM_PID_GYRO_D_ROLL, + EEPROM_PID_GYRO_D_PITCH, + EEPROM_PID_GYRO_D_YAW, /* Counts the amount of settings in profile */ EEPROM_PROFILE_COUNT diff --git a/UAV-ControlSystem/src/config/cli.c b/UAV-ControlSystem/src/config/cli.c index b6338fa..eb56233 100644 --- a/UAV-ControlSystem/src/config/cli.c +++ b/UAV-ControlSystem/src/config/cli.c @@ -222,6 +222,22 @@ typedef enum COMMAND_ID_FLAG_FLIGHTMODE_3_CHANNEL, + /* Profile values */ + + /* PID value */ + COMMAND_ID_PID_GYRO_P_ROLL, + COMMAND_ID_PID_GYRO_P_PITCH, + COMMAND_ID_PID_GYRO_P_YAW, + + COMMAND_ID_PID_GYRO_I_ROLL, + COMMAND_ID_PID_GYRO_I_PITCH, + COMMAND_ID_PID_GYRO_I_YAW, + + COMMAND_ID_PID_GYRO_D_ROLL, + COMMAND_ID_PID_GYRO_D_PITCH, + COMMAND_ID_PID_GYRO_D_YAW, + + /* Counter for the amount of commands */ COMMAND_ID_COUNT, @@ -265,10 +281,6 @@ const cliCommandConfig_t commandTable[COMMAND_ID_COUNT] = { { "adc_scales_right", COMMAND_ID_ADC_SCALES_RIGHT, EEPROM_ADC_SCALES, EEPROM_VALUE_TYPE_SYSTEM, 8, VAL_UINT_32, .valueRange = {0, 200} }, - [COMMAND_ID_PID_ROLL_KP] = - { - "pid_roll_kp", COMMAND_ID_PID_ROLL_KP, EEPROM_PID_ROLL_KP, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} - }, [COMMAND_ID_PERIOD_SYSTEM] = { "task_period_system", COMMAND_ID_PERIOD_SYSTEM, EEPROM_PERIOD_SYSTEM, EEPROM_VALUE_TYPE_SYSTEM, 0, VAL_UINT_32, .valueRange = {0, 1000000000} @@ -480,6 +492,47 @@ const cliCommandConfig_t commandTable[COMMAND_ID_COUNT] = { }, + //PROFILE VALUES + //PID VALUES + [COMMAND_ID_PID_GYRO_P_ROLL] = + { + "pid_gyro_p_roll", COMMAND_ID_PID_GYRO_P_ROLL, EEPROM_PID_GYRO_P_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + }, + [COMMAND_ID_PID_GYRO_P_PITCH] = + { + "pid_gyro_p_pitch", COMMAND_ID_PID_GYRO_P_PITCH, EEPROM_PID_GYRO_P_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + }, + [COMMAND_ID_PID_GYRO_P_YAW] = + { + "pid_gyro_p_yaw", COMMAND_ID_PID_GYRO_P_YAW, EEPROM_PID_GYRO_P_YAW, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + }, + + [COMMAND_ID_PID_GYRO_I_ROLL] = + { + "pid_gyro_i_roll", COMMAND_ID_PID_GYRO_I_ROLL, EEPROM_PID_GYRO_I_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + }, + [COMMAND_ID_PID_GYRO_I_PITCH] = + { + "pid_gyro_i_pitch", COMMAND_ID_PID_GYRO_I_PITCH, EEPROM_PID_GYRO_I_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + }, + [COMMAND_ID_PID_GYRO_I_YAW] = + { + "pid_gyro_i_yaw", COMMAND_ID_PID_GYRO_I_YAW, EEPROM_PID_GYRO_I_YAW, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + }, + + + [COMMAND_ID_PID_GYRO_D_ROLL] = + { + "pid_gyro_d_roll", COMMAND_ID_PID_GYRO_D_ROLL, EEPROM_PID_GYRO_D_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + }, + [COMMAND_ID_PID_GYRO_D_PITCH] = + { + "pid_gyro_d_pitch", COMMAND_ID_PID_GYRO_D_PITCH, EEPROM_PID_GYRO_D_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + }, + [COMMAND_ID_PID_GYRO_D_YAW] = + { + "pid_gyro_d_yaw", COMMAND_ID_PID_GYRO_D_YAW, EEPROM_PID_GYRO_D_YAW, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + }, }; diff --git a/UAV-ControlSystem/src/config/eeprom.c b/UAV-ControlSystem/src/config/eeprom.c index 15e85c1..52c601f 100644 --- a/UAV-ControlSystem/src/config/eeprom.c +++ b/UAV-ControlSystem/src/config/eeprom.c @@ -23,6 +23,7 @@ #include "Scheduler/scheduler.h" #include "drivers/failsafe_toggles.h" #include "drivers/motormix.h" +#include "Flight/pid.h" /* Reads the EEPROM version from EEPROM - Is compared to EEPROM_SYS_VERSION */ uint8_t stored_eeprom_identifier; @@ -245,11 +246,56 @@ EEPROM_DATA_t eeprom_sys_Arr[EEPROM_SYS_COUNT] = { /* Data pointers and sizes for profile content */ EEPROM_DATA_t eeprom_profile_Arr[EEPROM_PROFILE_COUNT] = { - [EEPROM_PID_ROLL_KP] = + //GYRO P VAL + [EEPROM_PID_GYRO_P_ROLL] = { - .size = sizeof(pid_pitch_pk), - .dataPtr = &pid_pitch_pk, - } + .size = sizeof(PidGyroProfile.P), + .dataPtr = &PidGyroProfile.P[0], + }, + [EEPROM_PID_GYRO_P_PITCH] = + { + .size = sizeof(PidGyroProfile.P), + .dataPtr = &PidGyroProfile.P[1], + }, + [EEPROM_PID_GYRO_P_YAW] = + { + .size = sizeof(PidGyroProfile.P), + .dataPtr = &PidGyroProfile.P[2], + }, + + //GYRO I VAL + [EEPROM_PID_GYRO_I_ROLL] = + { + .size = sizeof(PidGyroProfile.I), + .dataPtr = &PidGyroProfile.I[0], + }, + [EEPROM_PID_GYRO_I_PITCH] = + { + .size = sizeof(PidGyroProfile.I), + .dataPtr = &PidGyroProfile.I[1], + }, + [EEPROM_PID_GYRO_I_YAW] = + { + .size = sizeof(PidGyroProfile.I), + .dataPtr = &PidGyroProfile.I[2], + }, + + //GYRO D VAL + [EEPROM_PID_GYRO_D_ROLL] = + { + .size = sizeof(PidGyroProfile.D), + .dataPtr = &PidGyroProfile.D[0], + }, + [EEPROM_PID_GYRO_D_PITCH] = + { + .size = sizeof(PidGyroProfile.D), + .dataPtr = &PidGyroProfile.D[1], + }, + [EEPROM_PID_GYRO_D_YAW] = + { + .size = sizeof(PidGyroProfile.D), + .dataPtr = &PidGyroProfile.D[2], + }, }; /* Data pointers and sizes for footer content */ From efd9f23f5502f0295a1d68a92dd6a8a6ed1e9d6c Mon Sep 17 00:00:00 2001 From: Lennart Eriksson Date: Fri, 14 Oct 2016 15:53:40 +0200 Subject: [PATCH 2/4] temp changes --- UAV-ControlSystem/inc/config/eeprom.h | 7 +++ UAV-ControlSystem/inc/system_variables.h | 2 +- UAV-ControlSystem/src/config/cli.c | 65 ++++++++++++++++++++---- UAV-ControlSystem/src/config/eeprom.c | 55 ++++++++++++++++---- 4 files changed, 109 insertions(+), 20 deletions(-) diff --git a/UAV-ControlSystem/inc/config/eeprom.h b/UAV-ControlSystem/inc/config/eeprom.h index d2f774d..0d5fe4b 100644 --- a/UAV-ControlSystem/inc/config/eeprom.h +++ b/UAV-ControlSystem/inc/config/eeprom.h @@ -204,6 +204,13 @@ typedef enum { EEPROM_PID_GYRO_D_PITCH, EEPROM_PID_GYRO_D_YAW, + EEPROM_PID_ACCEL_P_ROLL, + EEPROM_PID_ACCEL_P_PITCH, + EEPROM_PID_ACCEL_I_ROLL, + EEPROM_PID_ACCEL_I_PITCH, + EEPROM_PID_ACCEL_D_ROLL, + EEPROM_PID_ACCEL_D_PITCH, + /* Counts the amount of settings in profile */ EEPROM_PROFILE_COUNT } EEPROM_PROFILE_ID_t; diff --git a/UAV-ControlSystem/inc/system_variables.h b/UAV-ControlSystem/inc/system_variables.h index 0cc221e..607b8e1 100644 --- a/UAV-ControlSystem/inc/system_variables.h +++ b/UAV-ControlSystem/inc/system_variables.h @@ -14,7 +14,7 @@ #ifndef SYSTEM_VARIABLES_H_ #define SYSTEM_VARIABLES_H_ -#define EEPROM_SYS_VERSION 101 +#define EEPROM_SYS_VERSION 102 #define ADC_STATE #include "stm32f4xx.h" diff --git a/UAV-ControlSystem/src/config/cli.c b/UAV-ControlSystem/src/config/cli.c index eb56233..98aa545 100644 --- a/UAV-ControlSystem/src/config/cli.c +++ b/UAV-ControlSystem/src/config/cli.c @@ -225,6 +225,7 @@ typedef enum /* Profile values */ /* PID value */ + //GYRO COMMAND_ID_PID_GYRO_P_ROLL, COMMAND_ID_PID_GYRO_P_PITCH, COMMAND_ID_PID_GYRO_P_YAW, @@ -237,6 +238,18 @@ typedef enum COMMAND_ID_PID_GYRO_D_PITCH, COMMAND_ID_PID_GYRO_D_YAW, + //ACCEL + COMMAND_ID_PID_ACCEL_P_ROLL, + COMMAND_ID_PID_ACCEL_P_PITCH, + COMMAND_ID_PID_ACCEL_P_YAW, + + COMMAND_ID_PID_ACCEL_I_ROLL, + COMMAND_ID_PID_ACCEL_I_PITCH, + COMMAND_ID_PID_ACCEL_I_YAW, + + COMMAND_ID_PID_ACCEL_D_ROLL, + COMMAND_ID_PID_ACCEL_D_PITCH, + COMMAND_ID_PID_ACCEL_D_YAW, /* Counter for the amount of commands */ COMMAND_ID_COUNT, @@ -494,44 +507,76 @@ const cliCommandConfig_t commandTable[COMMAND_ID_COUNT] = { //PROFILE VALUES //PID VALUES + //GYRO P [COMMAND_ID_PID_GYRO_P_ROLL] = { - "pid_gyro_p_roll", COMMAND_ID_PID_GYRO_P_ROLL, EEPROM_PID_GYRO_P_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + "pid_gyro_p_roll", COMMAND_ID_PID_GYRO_P_ROLL, EEPROM_PID_GYRO_P_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} }, [COMMAND_ID_PID_GYRO_P_PITCH] = { - "pid_gyro_p_pitch", COMMAND_ID_PID_GYRO_P_PITCH, EEPROM_PID_GYRO_P_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + "pid_gyro_p_pitch", COMMAND_ID_PID_GYRO_P_PITCH, EEPROM_PID_GYRO_P_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} }, [COMMAND_ID_PID_GYRO_P_YAW] = { - "pid_gyro_p_yaw", COMMAND_ID_PID_GYRO_P_YAW, EEPROM_PID_GYRO_P_YAW, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + "pid_gyro_p_yaw", COMMAND_ID_PID_GYRO_P_YAW, EEPROM_PID_GYRO_P_YAW, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} }, + //GYRO I [COMMAND_ID_PID_GYRO_I_ROLL] = { - "pid_gyro_i_roll", COMMAND_ID_PID_GYRO_I_ROLL, EEPROM_PID_GYRO_I_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + "pid_gyro_i_roll", COMMAND_ID_PID_GYRO_I_ROLL, EEPROM_PID_GYRO_I_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} }, [COMMAND_ID_PID_GYRO_I_PITCH] = { - "pid_gyro_i_pitch", COMMAND_ID_PID_GYRO_I_PITCH, EEPROM_PID_GYRO_I_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + "pid_gyro_i_pitch", COMMAND_ID_PID_GYRO_I_PITCH, EEPROM_PID_GYRO_I_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} }, [COMMAND_ID_PID_GYRO_I_YAW] = { - "pid_gyro_i_yaw", COMMAND_ID_PID_GYRO_I_YAW, EEPROM_PID_GYRO_I_YAW, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + "pid_gyro_i_yaw", COMMAND_ID_PID_GYRO_I_YAW, EEPROM_PID_GYRO_I_YAW, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} }, - + //GYRO D [COMMAND_ID_PID_GYRO_D_ROLL] = { - "pid_gyro_d_roll", COMMAND_ID_PID_GYRO_D_ROLL, EEPROM_PID_GYRO_D_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + "pid_gyro_d_roll", COMMAND_ID_PID_GYRO_D_ROLL, EEPROM_PID_GYRO_D_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} }, [COMMAND_ID_PID_GYRO_D_PITCH] = { - "pid_gyro_d_pitch", COMMAND_ID_PID_GYRO_D_PITCH, EEPROM_PID_GYRO_D_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + "pid_gyro_d_pitch", COMMAND_ID_PID_GYRO_D_PITCH, EEPROM_PID_GYRO_D_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} }, [COMMAND_ID_PID_GYRO_D_YAW] = { - "pid_gyro_d_yaw", COMMAND_ID_PID_GYRO_D_YAW, EEPROM_PID_GYRO_D_YAW, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 2000} + "pid_gyro_d_yaw", COMMAND_ID_PID_GYRO_D_YAW, EEPROM_PID_GYRO_D_YAW, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} + }, + + //ACCEL P + [COMMAND_ID_PID_ACCEL_P_ROLL] = + { + "pid_accel_p_roll", COMMAND_ID_PID_ACCEL_P_ROLL, EEPROM_PID_ACCEL_P_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} + }, + [COMMAND_ID_PID_ACCEL_P_PITCH] = + { + "pid_accel_p_pitch", COMMAND_ID_PID_ACCEL_P_PITCH, EEPROM_PID_ACCEL_P_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} + }, + + //ACCEL I + [COMMAND_ID_PID_ACCEL_I_ROLL] = + { + "pid_accel_i_roll", COMMAND_ID_PID_ACCEL_I_ROLL, EEPROM_PID_ACCEL_I_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} + }, + [COMMAND_ID_PID_ACCEL_I_PITCH] = + { + "pid_accel_i_pitch", COMMAND_ID_PID_ACCEL_I_PITCH, EEPROM_PID_ACCEL_I_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} + }, + + //ACCEL D + [COMMAND_ID_PID_ACCEL_D_ROLL] = + { + "pid_accel_d_roll", COMMAND_ID_PID_ACCEL_D_ROLL, EEPROM_PID_ACCEL_D_ROLL, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} + }, + [COMMAND_ID_PID_ACCEL_D_PITCH] = + { + "pid_accel_d_pitch", COMMAND_ID_PID_ACCEL_D_PITCH, EEPROM_PID_ACCEL_D_PITCH, EEPROM_VALUE_TYPE_PROFILE, 0, VAL_UINT_8, .valueRange = {0, 100} }, diff --git a/UAV-ControlSystem/src/config/eeprom.c b/UAV-ControlSystem/src/config/eeprom.c index 52c601f..27b40d8 100644 --- a/UAV-ControlSystem/src/config/eeprom.c +++ b/UAV-ControlSystem/src/config/eeprom.c @@ -249,53 +249,90 @@ EEPROM_DATA_t eeprom_profile_Arr[EEPROM_PROFILE_COUNT] = { //GYRO P VAL [EEPROM_PID_GYRO_P_ROLL] = { - .size = sizeof(PidGyroProfile.P), + .size = sizeof(PidGyroProfile.P[0]), .dataPtr = &PidGyroProfile.P[0], }, [EEPROM_PID_GYRO_P_PITCH] = { - .size = sizeof(PidGyroProfile.P), + .size = sizeof(PidGyroProfile.P[1]), .dataPtr = &PidGyroProfile.P[1], }, [EEPROM_PID_GYRO_P_YAW] = { - .size = sizeof(PidGyroProfile.P), + .size = sizeof(PidGyroProfile.P[2]), .dataPtr = &PidGyroProfile.P[2], }, //GYRO I VAL [EEPROM_PID_GYRO_I_ROLL] = { - .size = sizeof(PidGyroProfile.I), + .size = sizeof(PidGyroProfile.I[0]), .dataPtr = &PidGyroProfile.I[0], }, [EEPROM_PID_GYRO_I_PITCH] = { - .size = sizeof(PidGyroProfile.I), + .size = sizeof(PidGyroProfile.I[1]), .dataPtr = &PidGyroProfile.I[1], }, [EEPROM_PID_GYRO_I_YAW] = { - .size = sizeof(PidGyroProfile.I), + .size = sizeof(PidGyroProfile.I[2]), .dataPtr = &PidGyroProfile.I[2], }, //GYRO D VAL [EEPROM_PID_GYRO_D_ROLL] = { - .size = sizeof(PidGyroProfile.D), + .size = sizeof(PidGyroProfile.D[0]), .dataPtr = &PidGyroProfile.D[0], }, [EEPROM_PID_GYRO_D_PITCH] = { - .size = sizeof(PidGyroProfile.D), + .size = sizeof(PidGyroProfile.D[1]), .dataPtr = &PidGyroProfile.D[1], }, [EEPROM_PID_GYRO_D_YAW] = { - .size = sizeof(PidGyroProfile.D), + .size = sizeof(PidGyroProfile.D[2]), .dataPtr = &PidGyroProfile.D[2], }, + + //ACCEL P VAL + [EEPROM_PID_ACCEL_P_ROLL] = + { + .size = sizeof(PidAccelerometerProfile.P[0]), + .dataPtr = &PidAccelerometerProfile.P[0], + }, + [EEPROM_PID_ACCEL_P_PITCH] = + { + .size = sizeof(PidAccelerometerProfile.P[1]), + .dataPtr = &PidAccelerometerProfile.P[1], + }, + + //ACCEL I VAL + [EEPROM_PID_ACCEL_I_ROLL] = + { + .size = sizeof(PidAccelerometerProfile.I[0]), + .dataPtr = &PidAccelerometerProfile.I[0], + }, + [EEPROM_PID_ACCEL_I_PITCH] = + { + .size = sizeof(PidAccelerometerProfile.I[1]), + .dataPtr = &PidAccelerometerProfile.I[1], + }, + + //ACCEL_D_VAL + [EEPROM_PID_ACCEL_D_ROLL] = + { + .size = sizeof(PidAccelerometerProfile.D[0]), + .dataPtr = &PidAccelerometerProfile.D[0], + }, + [EEPROM_PID_ACCEL_D_PITCH] = + { + .size = sizeof(PidAccelerometerProfile.D[1]), + .dataPtr = &PidAccelerometerProfile.D[1], + }, + }; /* Data pointers and sizes for footer content */ From d5dcbf9c258b66ee1933243eee208454323332cb Mon Sep 17 00:00:00 2001 From: Lennart Eriksson Date: Mon, 17 Oct 2016 09:05:34 +0200 Subject: [PATCH 3/4] cli / eeprom implementation tested and verified --- UAV-ControlSystem/src/config/cli.c | 3 --- UAV-ControlSystem/src/main.c | 7 ++++--- 2 files changed, 4 insertions(+), 6 deletions(-) diff --git a/UAV-ControlSystem/src/config/cli.c b/UAV-ControlSystem/src/config/cli.c index 98aa545..861f973 100644 --- a/UAV-ControlSystem/src/config/cli.c +++ b/UAV-ControlSystem/src/config/cli.c @@ -241,15 +241,12 @@ typedef enum //ACCEL COMMAND_ID_PID_ACCEL_P_ROLL, COMMAND_ID_PID_ACCEL_P_PITCH, - COMMAND_ID_PID_ACCEL_P_YAW, COMMAND_ID_PID_ACCEL_I_ROLL, COMMAND_ID_PID_ACCEL_I_PITCH, - COMMAND_ID_PID_ACCEL_I_YAW, COMMAND_ID_PID_ACCEL_D_ROLL, COMMAND_ID_PID_ACCEL_D_PITCH, - COMMAND_ID_PID_ACCEL_D_YAW, /* Counter for the amount of commands */ COMMAND_ID_COUNT, diff --git a/UAV-ControlSystem/src/main.c b/UAV-ControlSystem/src/main.c index 02a0d1d..42b6ceb 100644 --- a/UAV-ControlSystem/src/main.c +++ b/UAV-ControlSystem/src/main.c @@ -45,19 +45,20 @@ void init_system() //Configure the clock system_clock_config(); + pidInit(); + /* read saved variables from eeprom, in most cases eeprom should be read after a lot of the initializes */ readEEPROM(); //initialize the CLI NOTE: Cant use the same usart as anything else or there will be some big trouble - cliInit(USART3); + cliInit(USART1); //init sbus, using USART1 - sbus_init(); +// sbus_init(); //init motors to run with oneshot 125 pwmEnableAllMotors(Oneshot125); - pidInit(); #ifdef USE_LEDS //Initialize the on board leds From 8c5d82e41611d6902d181331598ada6db06464f3 Mon Sep 17 00:00:00 2001 From: Lennart Eriksson Date: Mon, 17 Oct 2016 09:08:36 +0200 Subject: [PATCH 4/4] Fix --- UAV-ControlSystem/src/main.c | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/UAV-ControlSystem/src/main.c b/UAV-ControlSystem/src/main.c index 42b6ceb..e234eea 100644 --- a/UAV-ControlSystem/src/main.c +++ b/UAV-ControlSystem/src/main.c @@ -51,10 +51,10 @@ void init_system() readEEPROM(); //initialize the CLI NOTE: Cant use the same usart as anything else or there will be some big trouble - cliInit(USART1); + cliInit(USART3); //init sbus, using USART1 -// sbus_init(); + sbus_init(); //init motors to run with oneshot 125 pwmEnableAllMotors(Oneshot125);