Compare commits

..

No commits in common. "master" and "reel" have entirely different histories.
master ... reel

31 changed files with 376 additions and 591 deletions

View file

@ -130,7 +130,7 @@
<SetRegEntry>
<Number>0</Number>
<Key>DLGTARM</Key>
<Name>(1010=-1,-1,-1,-1,0)(1007=-1,-1,-1,-1,0)(1008=204,363,702,652,0)(1009=-1,-1,-1,-1,0)(100=-1,-1,-1,-1,0)(110=-1,-1,-1,-1,0)(111=-1,-1,-1,-1,0)(1011=-1,-1,-1,-1,0)(180=-1,-1,-1,-1,0)(120=293,271,851,768,0)(121=854,376,1412,873,0)(122=-1,-1,-1,-1,0)(123=-1,-1,-1,-1,0)(140=-1,-1,-1,-1,0)(240=-1,-1,-1,-1,0)(190=-1,-1,-1,-1,0)(200=-1,-1,-1,-1,0)(170=-1,-1,-1,-1,0)(130=200,173,988,1026,0)(131=410,141,1198,994,0)(132=161,47,949,900,0)(133=966,188,1754,1041,0)(160=-1,-1,-1,-1,0)(161=-1,-1,-1,-1,0)(162=-1,-1,-1,-1,0)(210=-1,-1,-1,-1,0)(211=-1,-1,-1,-1,0)(220=-1,-1,-1,-1,0)(221=-1,-1,-1,-1,0)(230=-1,-1,-1,-1,0)(231=-1,-1,-1,-1,0)(232=-1,-1,-1,-1,0)(233=-1,-1,-1,-1,0)(150=320,247,1120,1026,0)(151=1120,301,1920,1080,0)</Name>
<Name>(1010=-1,-1,-1,-1,0)(1007=-1,-1,-1,-1,0)(1008=204,363,702,652,0)(1009=-1,-1,-1,-1,0)(100=-1,-1,-1,-1,0)(110=-1,-1,-1,-1,0)(111=-1,-1,-1,-1,0)(1011=-1,-1,-1,-1,0)(180=-1,-1,-1,-1,0)(120=1045,583,1603,1080,0)(121=971,583,1529,1080,0)(122=-1,-1,-1,-1,0)(123=-1,-1,-1,-1,0)(140=-1,-1,-1,-1,0)(240=-1,-1,-1,-1,0)(190=-1,-1,-1,-1,0)(200=-1,-1,-1,-1,0)(170=-1,-1,-1,-1,0)(130=200,173,988,1026,0)(131=405,227,1193,1080,0)(132=161,47,949,900,0)(133=1013,172,1801,1025,0)(160=-1,-1,-1,-1,0)(161=-1,-1,-1,-1,0)(162=-1,-1,-1,-1,0)(210=-1,-1,-1,-1,0)(211=-1,-1,-1,-1,0)(220=-1,-1,-1,-1,0)(221=-1,-1,-1,-1,0)(230=-1,-1,-1,-1,0)(231=-1,-1,-1,-1,0)(232=-1,-1,-1,-1,0)(233=-1,-1,-1,-1,0)(150=320,247,1120,1026,0)(151=1120,301,1920,1080,0)</Name>
</SetRegEntry>
<SetRegEntry>
<Number>0</Number>
@ -157,9 +157,41 @@
<Bp>
<Number>0</Number>
<Type>0</Type>
<LineNumber>41</LineNumber>
<EnabledFlag>0</EnabledFlag>
<Address>134220664</Address>
<ByteObject>0</ByteObject>
<HtxType>0</HtxType>
<ManyObjects>0</ManyObjects>
<SizeOfObject>0</SizeOfObject>
<BreakByAccess>0</BreakByAccess>
<BreakIfRCount>1</BreakIfRCount>
<Filename>..\Services\Accelerometer.c</Filename>
<ExecCommand></ExecCommand>
<Expression>\\NUCLEO_F103RB\../Services/Accelerometer.c\41</Expression>
</Bp>
<Bp>
<Number>1</Number>
<Type>0</Type>
<LineNumber>33</LineNumber>
<EnabledFlag>0</EnabledFlag>
<Address>134231986</Address>
<Address>134231164</Address>
<ByteObject>0</ByteObject>
<HtxType>0</HtxType>
<ManyObjects>0</ManyObjects>
<SizeOfObject>0</SizeOfObject>
<BreakByAccess>0</BreakByAccess>
<BreakIfRCount>1</BreakIfRCount>
<Filename>..\Services\Accelerometer.c</Filename>
<ExecCommand></ExecCommand>
<Expression>\\NUCLEO_F103RB\../Services/Accelerometer.c\33</Expression>
</Bp>
<Bp>
<Number>2</Number>
<Type>0</Type>
<LineNumber>33</LineNumber>
<EnabledFlag>0</EnabledFlag>
<Address>134231194</Address>
<ByteObject>0</ByteObject>
<HtxType>0</HtxType>
<ManyObjects>0</ManyObjects>
@ -175,12 +207,37 @@
<Ww>
<count>0</count>
<WinNumber>1</WinNumber>
<ItemText>sailAngle,0x0A</ItemText>
<ItemText>windAngle,0x0A</ItemText>
</Ww>
<Ww>
<count>1</count>
<WinNumber>1</WinNumber>
<ItemText>dutyCycle</ItemText>
<ItemText>angleDeg,0x0A</ItemText>
</Ww>
<Ww>
<count>2</count>
<WinNumber>1</WinNumber>
<ItemText>volts</ItemText>
</Ww>
<Ww>
<count>3</count>
<WinNumber>1</WinNumber>
<ItemText>angleRad</ItemText>
</Ww>
<Ww>
<count>4</count>
<WinNumber>1</WinNumber>
<ItemText>value,0x0A</ItemText>
</Ww>
<Ww>
<count>5</count>
<WinNumber>1</WinNumber>
<ItemText>speed,0x0A</ItemText>
</Ww>
<Ww>
<count>6</count>
<WinNumber>1</WinNumber>
<ItemText>TIMx-&gt;CCR2</ItemText>
</Ww>
</WatchWindow1>
<Tracepoint>
@ -340,7 +397,7 @@
<SetRegEntry>
<Number>0</Number>
<Key>DLGDARM</Key>
<Name>(1010=-1,-1,-1,-1,0)(1007=-1,-1,-1,-1,0)(1008=1554,213,1920,450,0)(1009=-1,-1,-1,-1,0)(100=-1,-1,-1,-1,0)(110=-1,-1,-1,-1,0)(111=-1,-1,-1,-1,0)(1011=-1,-1,-1,-1,0)(180=-1,-1,-1,-1,0)(120=129,555,687,1080,0)(121=924,444,1482,969,0)(122=-1,-1,-1,-1,0)(123=-1,-1,-1,-1,0)(140=-1,-1,-1,-1,0)(240=-1,-1,-1,-1,0)(190=-1,-1,-1,-1,0)(200=-1,-1,-1,-1,0)(170=-1,-1,-1,-1,0)(130=-1,-1,-1,-1,0)(131=-1,-1,-1,-1,0)(132=150,46,938,969,0)(133=0,157,788,1080,0)(160=1046,190,1640,699,0)(161=-1,-1,-1,-1,0)(162=-1,-1,-1,-1,0)(210=-1,-1,-1,-1,0)(211=-1,-1,-1,-1,0)(220=-1,-1,-1,-1,0)(221=-1,-1,-1,-1,0)(230=-1,-1,-1,-1,0)(234=-1,-1,-1,-1,0)(231=-1,-1,-1,-1,0)(232=-1,-1,-1,-1,0)(233=-1,-1,-1,-1,0)(150=130,96,930,1019,0)(151=127,38,927,961,0)</Name>
<Name>(1010=-1,-1,-1,-1,0)(1007=-1,-1,-1,-1,0)(1008=1554,213,1920,450,0)(1009=-1,-1,-1,-1,0)(100=-1,-1,-1,-1,0)(110=-1,-1,-1,-1,0)(111=-1,-1,-1,-1,0)(1011=-1,-1,-1,-1,0)(180=-1,-1,-1,-1,0)(120=129,555,687,1080,0)(121=924,444,1482,969,1)(122=-1,-1,-1,-1,0)(123=-1,-1,-1,-1,0)(140=-1,-1,-1,-1,0)(240=-1,-1,-1,-1,0)(190=-1,-1,-1,-1,0)(200=-1,-1,-1,-1,0)(170=-1,-1,-1,-1,0)(130=-1,-1,-1,-1,0)(131=-1,-1,-1,-1,0)(132=150,46,938,969,0)(133=-13,526,775,1449,1)(160=1046,190,1640,699,0)(161=-1,-1,-1,-1,0)(162=-1,-1,-1,-1,0)(210=-1,-1,-1,-1,0)(211=-1,-1,-1,-1,0)(220=-1,-1,-1,-1,0)(221=-1,-1,-1,-1,0)(230=-1,-1,-1,-1,0)(234=-1,-1,-1,-1,0)(231=-1,-1,-1,-1,0)(232=-1,-1,-1,-1,0)(233=-1,-1,-1,-1,0)(150=130,96,930,1019,0)(151=127,38,927,961,0)</Name>
</SetRegEntry>
<SetRegEntry>
<Number>0</Number>
@ -373,7 +430,24 @@
<Name>-U-O142 -O2254 -S0 -C0 -A0 -N00("ARM CoreSight SW-DP") -D00(1BA01477) -L00(0) -TO18 -TC10000000 -TP21 -TDS8007 -TDT0 -TDC1F -TIEFFFFFFFF -TIP8 -FO7 -FD20000000 -FC800 -FN1 -FF0STM32F10x_128.FLM -FS08000000 -FL020000 -FP0($$Device:STM32F103RB$Flash\STM32F10x_128.FLM)</Name>
</SetRegEntry>
</TargetDriverDllRegistry>
<Breakpoint/>
<Breakpoint>
<Bp>
<Number>0</Number>
<Type>0</Type>
<LineNumber>51</LineNumber>
<EnabledFlag>1</EnabledFlag>
<Address>134221038</Address>
<ByteObject>0</ByteObject>
<HtxType>0</HtxType>
<ManyObjects>0</ManyObjects>
<SizeOfObject>0</SizeOfObject>
<BreakByAccess>0</BreakByAccess>
<BreakIfRCount>1</BreakIfRCount>
<Filename>..\Src\Display.c</Filename>
<ExecCommand></ExecCommand>
<Expression>\\NUCLEO_F103RB\../Src/Display.c\51</Expression>
</Bp>
</Breakpoint>
<WatchWindow1>
<Ww>
<count>0</count>
@ -429,8 +503,8 @@
<periodic>1</periodic>
<aLwin>0</aLwin>
<aCover>0</aCover>
<aSer1>0</aSer1>
<aSer2>0</aSer2>
<aSer1>1</aSer1>
<aSer2>1</aSer2>
<aPa>0</aPa>
<viewmode>1</viewmode>
<vrSel>0</vrSel>
@ -439,12 +513,12 @@
<AscS1>0</AscS1>
<AscS2>0</AscS2>
<AscS3>0</AscS3>
<aSer3>0</aSer3>
<aSer3>1</aSer3>
<eProf>0</eProf>
<aLa>0</aLa>
<aLa>1</aLa>
<aPa1>0</aPa1>
<AscS4>0</AscS4>
<aSer4>0</aSer4>
<aSer4>1</aSer4>
<StkLoc>0</StkLoc>
<TrcWin>0</TrcWin>
<newCpu>0</newCpu>

View file

@ -15,10 +15,10 @@ void ADC_conf(ADC_TypeDef *adc)
// Division de la frequence
RCC->CFGR |= RCC_CFGR_ADCPRE_DIV6;
// Fixe le nombre de conversion <EFBFBD> 1
// Fixe le nombre de conversion à 1
adc->SQR1 &= ADC_SQR1_L;
// Calibration (ne fonctionne pas, mais pas necessaire donc ok)
// Calibration
// adc->CR2 |= ADC_CR2_CAL_Msk;
// while ((adc->CR2 & ADC_CR2_CAL_Msk));
}

View file

@ -3,46 +3,12 @@
#include "stm32f1xx_ll_adc.h"
/**
* @brief Active l'horloge et calibre l'ADC donné
* @note
* @param ADC_TypeDef adc : indique l'ADC à utiliser
* @retval None
*/
void ADC_conf(ADC_TypeDef *adc);
/**
* @brief Démarre l'ADC donné
* @note
* @param ADC_TypeDef adc : indique l'ADC à utiliser
* @retval None
*/
void ADC_start(ADC_TypeDef *adc);
/**
* @brief Récupère la valeur brute donnée par l'ADC
* @note
* @param ADC_TypeDef adc : indique l'ADC à utiliser
* int channel : le channel à lire
* @retval Valeur brute lue
*/
uint16_t ADC_readRaw(ADC_TypeDef *adc, int channel);
/**
* @brief Récupère la valeur en volts donnée par l'ADC
* @note
* @param ADC_TypeDef adc : indique l'ADC à utiliser
* int channel : le channel à lire
* @retval Valeur lue en volts
*/
float ADC_readVolt(ADC_TypeDef *adc, int channel);
/**
* @brief Converti la valeur brute donnée en volts
* @note
* @param int value : La valeur à convertir
* @retval La conversion en volts
*/
float ADC_convertToVolt(uint16_t value);

View file

@ -1,37 +1,37 @@
#include "GPIO.h"
#include "stm32f1xx_ll_gpio.h"
void GPIO_conf(GPIO_TypeDef * gpio, uint32_t pin, uint32_t mode, uint32_t outputType, uint32_t pullMode)
void GPIO_conf(GPIO_TypeDef * GPIOx, uint32_t PINx, uint32_t mode, uint32_t outputType, uint32_t pullMode)
{
LL_GPIO_InitTypeDef init;
//Activation de l'horloge
if (gpio == GPIOA) LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOA);
else if (gpio == GPIOB) LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOB);
else if (gpio == GPIOC) LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOC);
else if (gpio == GPIOD) LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOD);
if (GPIOx == GPIOA) LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOA);
else if (GPIOx == GPIOB) LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOB);
else if (GPIOx == GPIOC) LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOC);
else if (GPIOx == GPIOD) LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOD);
//Configuration du PIN
LL_GPIO_StructInit(&init);
init.Pin = pin;
init.Pin = PINx;
init.Mode = mode;
//init.Speed = ;
init.OutputType = outputType;
init.Pull = pullMode;
LL_GPIO_Init(gpio, &init);
LL_GPIO_Init(GPIOx, &init);
}
void GPIO_setPin(GPIO_TypeDef * gpio, uint32_t pin, int output)
void GPIO_setPin(GPIO_TypeDef * GPIOx, uint32_t PINx, int output)
{
if (output) {
LL_GPIO_SetOutputPin(gpio, pin);
LL_GPIO_SetOutputPin(GPIOx, PINx);
} else {
LL_GPIO_ResetOutputPin(gpio,pin);
LL_GPIO_ResetOutputPin(GPIOx,PINx);
}
};
int GPIO_readPin(GPIO_TypeDef * gpio, uint32_t pin)
int GPIO_readPin(GPIO_TypeDef * GPIOx, uint32_t PINx)
{
return LL_GPIO_IsOutputPinSet(gpio, pin);
return LL_GPIO_IsOutputPinSet(GPIOx, PINx);
}

View file

@ -7,31 +7,17 @@
/**
* @brief Active l'horloge du GPIO et configure le pin donné
* @brief Configure le GPIO considéré
* @note
* @param GPIO_TypeDef * gpio : indique le GPIO à configurer : GPIOA, GPIOB, GPIOC ou GPIOD
* uint32_t pin : indique le PIN à configurer, sous la forme LL_GPIO_PIN_x
* @param GPIO_TypeDef * GPIOx indique le GPIO à configurer : GPIOA, GPIOB, GPIOC ou GPIOD
uint32_t PINx indique le PIN à configurer, sous la forme LL_GPIO_PIN_x
Pour une liste des modes disponibles, consulter la librairie LL
* @retval None
*/
void GPIO_conf(GPIO_TypeDef * gpio, uint32_t pin, uint32_t mode, uint32_t outputType, uint32_t pullMode);
void GPIO_conf(GPIO_TypeDef * GPIOx, uint32_t PINx, uint32_t mode, uint32_t outputType, uint32_t pullMode);
/**
* @brief Mets le PIN à la valeur donnée
* @note
* @param GPIO_TypeDef * gpio : indique le GPIO à configurer : GPIOA, GPIOB, GPIOC ou GPIOD
* uint32_t pin : indique le PIN à configurer, sous la forme LL_GPIO_PIN_x
* int output : valeur du pin à mettre
* @retval None
*/
void GPIO_setPin(GPIO_TypeDef * gpio, uint32_t pin, int output);
void GPIO_setPin(GPIO_TypeDef * GPIOx, uint32_t PINx, int output);
/**
* @brief Récupère la valeur du PIN
* @note
* @param GPIO_TypeDef * gpio : indique le GPIO à configurer : GPIOA, GPIOB, GPIOC ou GPIOD
* uint32_t pin : indique le PIN à configurer, sous la forme LL_GPIO_PIN_x
* @retval 0 ou 1
*/
int GPIO_readPin(GPIO_TypeDef * gpio, uint32_t pin);
int GPIO_readPin(GPIO_TypeDef * GPIOx, uint32_t PINx);
#endif

View file

@ -45,18 +45,37 @@ void TIM4_IRQHandler(void)
}
/**
* @brief Autorise les interruptions
* @note
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* @retval None
*/
void Timer_IT_enable(TIM_TypeDef * timer)
{
LL_TIM_EnableIT_UPDATE(timer);
}
/**
* @brief Interdit les interruptions
* @note
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* @retval None
*/
void Timer_IT_disable(TIM_TypeDef * timer)
{
LL_TIM_DisableIT_UPDATE(timer);
}
/**
* @brief Configure le Timer consid<EFBFBD>r<EFBFBD> en interruption sur d<EFBFBD>bordement.
* @note A ce stade, les interruptions ne sont pas valid<EFBFBD>s (voir MyTimer_IT_Enable )
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* void (*IT_function) (void) : nom (adresse) de la fonction <EFBFBD> lancer sur interruption
* int Prio : priorit<EFBFBD> associ<EFBFBD>e <EFBFBD> l'interruption
* @retval None
*/
void Timer_IT_conf(TIM_TypeDef * timer, void (*it_callback) (void), int prio)
{
// affectation de la fonction
@ -66,7 +85,7 @@ void Timer_IT_conf(TIM_TypeDef * timer, void (*it_callback) (void), int prio)
else it_callback_TIM4 = it_callback;
// Blocage IT (il faudra la debloquer voir fct suivante)
// Blocage IT (il faudra la d<EFBFBD>bloquer voir fct suivante)
LL_TIM_DisableIT_UPDATE(timer);
// validation du canal NVIC
@ -87,17 +106,36 @@ void Timer_IT_conf(TIM_TypeDef * timer, void (*it_callback) (void), int prio)
* TIMER
***************************************************************************/
/**
* @brief D<EFBFBD>marre le timer consid<EFBFBD>r<EFBFBD> et active les interruptions
* @note
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* @retval None
*/
void Timer_start(TIM_TypeDef * timer)
{
LL_TIM_EnableCounter(timer);
}
/**
* @brief Arr<EFBFBD>t le timer consid<EFBFBD>r<EFBFBD> et d<EFBFBD>sactive les interruptions
* @note
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* @retval None
*/
void Timer_stop(TIM_TypeDef * timer)
{
LL_TIM_DisableCounter(timer);
}
/**
* @brief Active l'horloge et r<EFBFBD>gle l'ARR et le PSC du timer vis<EFBFBD>.
* @note Fonction <EFBFBD> lancer avant toute autre. Le timer n'est pas encore lanc<EFBFBD> (voir Timer_start)
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* int Arr : valeur <EFBFBD> placer dans ARR
* int Psc : valeur <EFBFBD> placer dans PSC
* @retval None
*/
void Timer_conf(TIM_TypeDef * timer, int arr, int psc)
{
LL_TIM_InitTypeDef init_struct;
@ -127,9 +165,8 @@ void Timer_conf(TIM_TypeDef * timer, int arr, int psc)
/****************************************************************************
* PWM INPUT
***************************************************************************/
void PWMi_conf(TIM_TypeDef * TIMx, int channel){
void Timer_pwmi_conf(TIM_TypeDef * TIMx, int channel)
{
//Periode à recuperer dans TIMx_CCR1, duty cycle dans TIMx_CCR2. Seul les 2 premiers channels peuvent être utilisés (cf 315).
// Validation horloge locale
@ -140,7 +177,7 @@ void Timer_pwmi_conf(TIM_TypeDef * TIMx, int channel)
if (channel == 1) {
//
TIMx -> CCMR1 |= TIM_CCMR1_CC1S_0;
TIMx -> CCMR1 |= TIM_CCMR1_CC2S_1;
@ -175,14 +212,14 @@ void Timer_pwmi_conf(TIM_TypeDef * TIMx, int channel)
//TIM_DIER_CC1DE_Pos; Probablement pas utile
}
int Timer_pwmi_getPeriod(TIM_TypeDef * TIMx)
{
int PWMi_getPeriod(TIM_TypeDef * TIMx) {
return TIMx->CCR1;
}
float Timer_pwmi_getDutyCycle(TIM_TypeDef * TIMx) {
const float arr = (float)LL_TIM_GetAutoReload(TIMx);
float duty_cycle = (float)TIMx->CCR2 / arr;
float PWMi_getDutyCycle(TIM_TypeDef * TIMx) {
const int arr = LL_TIM_GetAutoReload(TIMx);
float duty_cycle = (float)TIMx->CCR2 / (float)arr;
return duty_cycle;
}
@ -229,14 +266,10 @@ float Timer_pwmo_getDutyCycle(TIM_TypeDef * timer, int channel)
{
int compare = 0;
const int arr = LL_TIM_GetAutoReload(timer);
if (channel == LL_TIM_CHANNEL_CH1)
compare = LL_TIM_OC_GetCompareCH1(timer);
else if (channel == LL_TIM_CHANNEL_CH2)
compare = LL_TIM_OC_GetCompareCH2(timer);
else if (channel == LL_TIM_CHANNEL_CH3)
compare = LL_TIM_OC_GetCompareCH3(timer);
else
compare = LL_TIM_OC_GetCompareCH4(timer);
if (channel == LL_TIM_CHANNEL_CH1) compare = LL_TIM_OC_GetCompareCH1(timer);
else if (channel == LL_TIM_CHANNEL_CH2) compare = LL_TIM_OC_GetCompareCH2(timer);
else if (channel == LL_TIM_CHANNEL_CH3) compare = LL_TIM_OC_GetCompareCH3(timer);
else compare = LL_TIM_OC_GetCompareCH4(timer);
return ((float) compare) / ((float) arr);
}
@ -246,8 +279,6 @@ float Timer_pwmo_getDutyCycle(TIM_TypeDef * timer, int channel)
void Timer_encoder_conf(TIM_TypeDef * timer)
{
// L'encodeur compte 2 tours quand on en fait qu'un, donc on divise l'angle
// par deux avant de le renvoyer. Il faut donc un autoreload de 360 * 2 = 720
Timer_conf(timer, 719, 0);
LL_TIM_ENCODER_InitTypeDef init_struct;
LL_TIM_ENCODER_StructInit(&init_struct);
@ -259,8 +290,6 @@ void Timer_encoder_conf(TIM_TypeDef * timer)
int Timer_encoder_getAngle(TIM_TypeDef * timer)
{
// L'encodeur compte 2 tours quand on en fait qu'un, donc on divise l'angle
// par deux avant de le renvoyer
return LL_TIM_GetCounter(timer)/2;
}

View file

@ -14,30 +14,10 @@ enum CounterDirection {
* INTERRUPTIONS
***************************************************************************/
/**
* @brief Autorise les interruptions
* @note
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* @retval None
*/
void Timer_IT_enable(TIM_TypeDef * timer);
/**
* @brief Interdit les interruptions
* @note
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* @retval None
*/
void Timer_IT_disable(TIM_TypeDef * timer);
/**
* @brief Configure le Timer consid<EFBFBD>r<EFBFBD> en interruption sur d<EFBFBD>bordement.
* @note A ce stade, les interruptions ne sont pas valid<EFBFBD>s (voir MyTimer_IT_Enable )
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* void (*IT_function) (void) : nom (adresse) de la fonction <EFBFBD> lancer sur interruption
* int Prio : priorit<EFBFBD> associ<EFBFBD>e <EFBFBD> l'interruption
* @retval None
*/
void Timer_IT_conf(TIM_TypeDef * timer, void (*it_callback) (void), int prio);
@ -45,60 +25,45 @@ void Timer_IT_conf(TIM_TypeDef * timer, void (*it_callback) (void), int prio);
* TIMER
***************************************************************************/
/**
* @brief Démarre le timer considéré
* @brief Active l'horloge et r<EFBFBD>gle l'ARR et le PSC du timer vis<EFBFBD>
* @note Fonction <EFBFBD> lancer avant toute autre. Le timer n'est pas encore lanc<EFBFBD> (voir MyTimerStart)
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* int Arr : valeur <EFBFBD> placer dans ARR
* int Psc : valeur <EFBFBD> placer dans PSC
* @retval None
*/
void Timer_conf(TIM_TypeDef * timer, int arr, int psc);
/**
* @brief D<EFBFBD>marre le timer consid<EFBFBD>r<EFBFBD>
* @note
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* @retval None
*/
void Timer_start(TIM_TypeDef * timer);
/**
* @brief Arrête le timer considéré
* @brief Arr<EFBFBD>t le timer consid<EFBFBD>r<EFBFBD>
* @note
* @param TIM_TypeDef Timer : indique le timer <EFBFBD> utiliser par le chronom<EFBFBD>tre, TIM1, TIM2, TIM3 ou TIM4
* @retval None
*/
void Timer_stop(TIM_TypeDef * timer);
/**
* @brief Active l'horloge et regle l'ARR et le PSC du timer visé
* @param TIM_TypeDef Timer : indique le timer à utiliser
* int Arr : valeur à placer dans ARR
* int Psc : valeur à placer dans PSC
* @retval None
*/
void Timer_conf(TIM_TypeDef * timer, int arr, int psc);
/****************************************************************************
* PWM INPUT
***************************************************************************/
/**
* @brief Configure le timer en mode PWM input
* @note
* @param TIM_TypeDef Timer : indique le timer à utiliser : TIM1, TIM2, TIM3 ou TIM4
* int channel : Le channel utilisé par la PWM (pas LL)
* @retval None
*/
void Timer_pwmi_conf(TIM_TypeDef * timer, int channel);
void PWMi_conf(TIM_TypeDef * timer, int channel);
/**
* @brief Récupère le duty cycle de la PWM donnée
* @note
* @param TIM_TypeDef Timer : indique le timer à utiliser
* @retval None
*/
float Timer_pwmi_getDutyCycle(TIM_TypeDef * timer);
float PWMi_getDutyCycle(TIM_TypeDef * timer);
/**
* @brief Récupère la période de la PWM donnée
* @note
* @param TIM_TypeDef Timer : indique le timer à utiliser
* @retval None
*/
int Timer_pwmi_getPeriod(TIM_TypeDef * timer);
int PWMi_getPeriod(TIM_TypeDef * TIMx);
/****************************************************************************
* PWM OUTPUT

View file

@ -3,22 +3,22 @@
#include "stm32f1xx_ll_bus.h" // Pour horloge
void USART_conf(USART_TypeDef *usart)
void Usart_conf(USART_TypeDef *USARTx)
{
int txPin;
GPIO_TypeDef *usartGpio;
if (usart == USART1) {
if (USARTx == USART1) {
LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_USART1);
LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOA);
txPin = LL_GPIO_PIN_9;
usartGpio = GPIOA;
} else if (usart == USART2) {
} else if (USARTx == USART2) {
LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_USART2);
LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOA);
txPin = LL_GPIO_PIN_2;
usartGpio = GPIOA;
} else if (usart == USART3) {
} else if (USARTx == USART3) {
LL_APB1_GRP1_EnableClock(LL_APB1_GRP1_PERIPH_USART3);
LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_GPIOB);
txPin = LL_GPIO_PIN_10;
@ -30,26 +30,30 @@ void USART_conf(USART_TypeDef *usart)
usartInit.DataWidth = LL_USART_DATAWIDTH_8B;
usartInit.BaudRate = 9600;
usartInit.TransferDirection = LL_USART_DIRECTION_TX_RX;
LL_USART_Init(usart, &usartInit);
LL_USART_Init(USARTx, &usartInit);
GPIO_conf(usartGpio, txPin, LL_GPIO_MODE_ALTERNATE, LL_GPIO_OUTPUT_PUSHPULL, LL_GPIO_PULL_UP);
}
void USART_start(USART_TypeDef *usart)
void Usart_enable(USART_TypeDef *USARTx)
{
LL_USART_Enable(usart);
LL_USART_Enable(USARTx);
}
void sendChar(USART_TypeDef *usart, char c)
void sendChar(USART_TypeDef *USARTx, char c)
{
LL_USART_TransmitData8(usart, c);
while (!LL_USART_IsActiveFlag_TXE(usart)) {}
LL_USART_TransmitData8(USARTx, c);
while (!LL_USART_IsActiveFlag_TXE(USARTx)) {}
}
void USART_send(USART_TypeDef *usart, char *msg, int length)
void Usart_send(USART_TypeDef *USARTx, char *msg, int length)
{
for (int i = 0; i < length; i++) {
sendChar(usart, msg[i]);
sendChar(USARTx, msg[i]);
}
}

View file

@ -3,30 +3,8 @@
#include "stm32f1xx_ll_usart.h"
/**
* @brief Active l'horloge de l'USART et configure le pin associé
* @note
* @param USART_TypeDef * usart : indique l'USART à configurer
* @retval None
*/
void USART_conf(USART_TypeDef *USARTx);
/**
* @brief Démarre l'USART
* @note
* @param USART_TypeDef * usart : indique l'USART à configurer
* @retval None
*/
void USART_start(USART_TypeDef *USARTx);
/**
* @brief envoie le message donné par l'USART
* @note
* @param USART_TypeDef * usart : indique l'USART à configurer
* char msg : Le message à envoyer
* int length : La longueur du message
* @retval None
*/
void USART_send(USART_TypeDef *USARTx, char *msg, int length);
void Usart_conf(USART_TypeDef *USARTx);
void Usart_enable(USART_TypeDef *USARTx);
void Usart_send(USART_TypeDef *USARTx, char *msg, int length);
#endif

View file

@ -1,7 +1,6 @@
#include "Accelerometer.h"
#include "ADC.h"
#include "math.h"
#include "stdio.h"
#define M_PI 3.14159265358979323846
@ -9,10 +8,8 @@
// Donc sensibilité de +- 480 mv/g
const float ZERO_G = 1.27; // 0 g
const float SENSITIVITY = 1.35-0.9;
// max: 1.75
// min: 0.935
const float ZERO_G = 1.65; // 0 g
const float SENSITIVITY = 0.48;
void Accelerometer_conf(ADC_TypeDef *adc, GPIO_TypeDef * gpio, int pinx, int piny)
{
@ -38,8 +35,7 @@ float voltsToG(float volts)
int Accelerometer_getAngle(ADC_TypeDef *adc, int channel)
{
const float readV = ADC_readVolt(adc, channel);
const float readG = voltsToG(readV);
const float readG = voltsToG(ADC_readVolt(adc, channel));
float angleRad = asin(readG);
int angleDeg = angleRad * (180/M_PI);

View file

@ -4,32 +4,10 @@
#include "GPIO.h"
#include "stm32f1xx_ll_adc.h"
/**
* @brief Configure l'ADC et les GPIO de l'accéléromètre
* @note
* @param adc : ADC utilisé pour convertir les valeurs
* gpio : Gpio utilisé par l'accéléromètre
* pinx : Pin pour l'axe X
* piny : Pin pour l'axe Y
* @retval None
*/
void Accelerometer_conf(ADC_TypeDef *adc, GPIO_TypeDef * gpio, int pinx, int piny);
/**
* @brief Démarre l'ADC de l'accéléromètre
* @note
* @param None
* @retval None
*/
void Accelerometer_start(ADC_TypeDef *adc);
/**
* @brief Récupère l'angle de l'accéléromètre lié au channel donné
* @note
* @param adc : ADC utilisé pour convertir les valeurs
* channel : channel utilisé par l'axe
* @retval L'ange en degrès de l'axe choisi
*/
int Accelerometer_getAngle(ADC_TypeDef *adc, int channel);
#endif

View file

@ -1,20 +1,18 @@
#include "DCMotor.h"
#include "math.h"
const int MOTOR_PWM_FREQ = 50;
void DCMotor_conf(TIM_TypeDef * timer, int channel, GPIO_TypeDef * gpioPwm, int pinPwm, GPIO_TypeDef * gpioDirection, int pinDirection)
void DCMotor_conf(TIM_TypeDef * timer, int channel, GPIO_TypeDef * gpio, int pin)
{
// On regle la vitesse en valeur absolue, ici a 0
Timer_pwmo_conf(timer, channel, MOTOR_PWM_FREQ, 0);
//On règle la vitesse en valeur absolue, ici à 0
Timer_pwmo_conf(timer, channel, 50, 0);
// Configuration du GPIO
GPIO_conf(gpioPwm, pinPwm, LL_GPIO_MODE_ALTERNATE, LL_GPIO_OUTPUT_PUSHPULL, LL_GPIO_PULL_UP);
GPIO_conf(GPIOA, LL_GPIO_PIN_1, LL_GPIO_MODE_ALTERNATE, LL_GPIO_OUTPUT_PUSHPULL, LL_GPIO_PULL_UP);
// On regle le sens du moteur
GPIO_conf(gpioDirection, pinDirection, LL_GPIO_MODE_OUTPUT, LL_GPIO_OUTPUT_PUSHPULL, LL_GPIO_PULL_DOWN);
GPIO_setPin(gpioDirection, pinDirection, 0);
//On règle le sens du moteur, ici sens direct (?)
GPIO_conf(gpio, pin, LL_GPIO_MODE_OUTPUT, LL_GPIO_OUTPUT_PUSHPULL, LL_GPIO_PULL_DOWN);
GPIO_setPin(gpio, pin, 0);
Timer_start(timer);
}
@ -23,7 +21,8 @@ void DCMotor_conf(TIM_TypeDef * timer, int channel, GPIO_TypeDef * gpioPwm, int
void DCMotor_setSpeed(TIM_TypeDef * timer, int channel, GPIO_TypeDef * gpio, int pin, float speed)
{
const int dir = speed > 0.0;
const int dir = (speed > 0.) ? 1 : 0;
Timer_pwmo_setDutyCycle(timer, channel, fabs(speed));
GPIO_setPin(gpio, pin, dir);
}
@ -32,5 +31,6 @@ float DCMotor_getSpeed(TIM_TypeDef * timer, int channel, GPIO_TypeDef * gpio, in
{
const float speedAbs = Timer_pwmo_getDutyCycle(timer, channel);
const int dir = GPIO_readPin(gpio, pin);
return dir ? speedAbs : -speedAbs;
}

View file

@ -4,39 +4,10 @@
#include "GPIO.h"
#include "Timer.h"
/**
* @brief Configure le Timer et le GPIO du DCmotor
* @note
* @param timer : Timer utilise pour controler le moteur
* channel : channel du timer
* gpio : GPIO utilise pour regler le sens du moteur
* pin : Pin pour l'axe Y
* @retval None
*/
void DCMotor_conf(TIM_TypeDef * timer, int channel, GPIO_TypeDef * gpioPwm, int pinPwm, GPIO_TypeDef * gpioDirection, int pinDirection);
void DCMotor_conf(TIM_TypeDef * timer, int channel, GPIO_TypeDef * gpio, int pin);
/**
* @brief Configure le Timer et le GPIO du DCmotor
* @note
* @param timer : Timer utilise pour controler le moteur
* channel : channel du timer
* gpio : GPIO utilise pour regler le sens du moteur
* pin : Pin pour l'axe Y
* speed : vitesse voulue
* @retval None
*/
void DCMotor_setSpeed(TIM_TypeDef * timer, int channel, GPIO_TypeDef * gpio, int pin, float speed);
/**
* @brief Recupere la vitesse actuelle du moteur
* @note
* @param timer : Timer utilise pour controler le moteur
* channel : channel du timer
* gpio : GPIO utilise pour regler le sens du moteur
* pin : Pin pour l'axe Y
* speed : vitesse voulue
* @retval None
*/
float DCMotor_getSpeed(TIM_TypeDef * timer, int channel, GPIO_TypeDef * gpio, int pin);
#endif

View file

@ -4,36 +4,34 @@
#include "stm32f103xb.h"
/**
* @brief Configure le timer et le pin du gpio pour le codeur incremental
* @brief Configure le codeur incrémental associé au timer donné
* @note
* @param TIM_TypeDef timer : le timer a utiliser
* GPIO_TypeDef gpio : le gpio a utiliser pour le zero
* int pin : le pin associe au GPIO pour le zero
* @param TIM_TypeDef Timer : indique le timer à utiliser : TIM1, TIM2, TIM3 ou TIM4
* @retval None
*/
void IncrementalEncoder_conf(TIM_TypeDef * timer, GPIO_TypeDef * gpio, int pin);
/**
* @brief Demarre le timer pour le codeur incremental
* @brief Démarre le codeur incrémental associé au timer donné
* @note
* @param TIM_TypeDef timer : le timer a utiliser
* @param TIM_TypeDef Timer : indique le timer à utiliser : TIM1, TIM2, TIM3 ou TIM4
* @retval None
*/
void IncrementalEncoder_start(TIM_TypeDef * timer);
/**
* @brief Recupere l'angle du codeur incremental associe au timer donne
* @brief Récupère l'angle du codeur incrémental associé au timer donné
* @note
* @param TIM_TypeDef timer : le timer a utiliser
* @retval L'angle en degres
* @param TIM_TypeDef Timer : indique le timer à utiliser : TIM1, TIM2, TIM3 ou TIM4
* @retval int angle
*/
int IncrementalEncoder_getAngle(TIM_TypeDef * timer);
/**
* @brief Recupere la direction du codeur incremental associe au timer donne
* @brief Récupère la direction du codeur incrémental associé au timer donné
* @note
* @param TIM_TypeDef timer : le timer a utiliser
* @retval la direction actuelle du codeur
* @param TIM_TypeDef Timer : indique le timer à utiliser : TIM1, TIM2, TIM3 ou TIM4
* @retval int dir
*/
enum CounterDirection IncrementalEncoder_getDirection(TIM_TypeDef * timer);

View file

@ -6,12 +6,12 @@ void RFEmitter_conf(USART_TypeDef * usart, GPIO_TypeDef *gpioTXEnable, int pinTX
// Configuration du pin TXEnable
GPIO_conf(gpioTXEnable, pinTXEnable, LL_GPIO_MODE_OUTPUT, LL_GPIO_OUTPUT_PUSHPULL, 0);
// Configuration de l'USART
USART_conf(usart);
Usart_conf(usart);
}
void RFEmitter_start(USART_TypeDef * usart)
{
USART_start(usart);
Usart_enable(usart);
}
void RFEmitter_send(USART_TypeDef * usart, char * message, int longueur, GPIO_TypeDef *gpioTXEnable, int pinTXEnable)
@ -20,7 +20,7 @@ void RFEmitter_send(USART_TypeDef * usart, char * message, int longueur, GPIO_Ty
GPIO_setPin(gpioTXEnable, pinTXEnable, 1);
// Envoi du message
USART_send(usart, message, longueur);
Usart_send(usart, message, longueur);
// reset PA11 (TXEnable)
GPIO_setPin(gpioTXEnable, pinTXEnable, 0);

View file

@ -3,34 +3,10 @@
#include "USART.h"
/**
* @brief Configure l'USART et le pin du gpio pour l'émetteur
* @note
* @param USART_TypeDef usart : l'usart à utiliser pour transmettre les informations
* GPIO_TypeDef gpioTXEnable : le gpio à utiliser pour activer l'emetteur
* int pinTXEnable : le pin associé au GPIO
* @retval None
*/
void RFEmitter_conf(USART_TypeDef * usart, GPIO_TypeDef *gpioTXEnable, int pinTXEnable);
/**
* @brief Démarre l'USART l'émetteur
* @note
* @param USART_TypeDef usart : l'usart à utiliser pour transmettre les informations
* @retval None
*/
void RFEmitter_start(USART_TypeDef * usart);
/**
* @brief Envoie le message donnée par l'émetteur
* @note
* @param USART_TypeDef usart : l'usart à utiliser pour transmettre les informations
* char message : le message à envoyer
* int longueur : la longueur du message
* GPIO_TypeDef gpioTXEnable : le gpio à utiliser pour activer l'emetteur
* int pinTXEnable : le pin associé au GPIO
* @retval None
*/
void RFEmitter_send(USART_TypeDef * usart, char * message, int longueur, GPIO_TypeDef *gpioTXEnable, int pinTXEnable);
#endif

View file

@ -2,10 +2,14 @@
void RFReceiver_conf(TIM_TypeDef * timer, int channel)
{
Timer_pwmi_conf(timer, channel);
PWMi_conf(timer, channel);
}
float RFReceiver_getData(TIM_TypeDef * timer)
{
return Timer_pwmi_getDutyCycle(timer);
const float duty_cycle = PWMi_getDutyCycle(timer);
// const int period = PWMi_getPeriod(timer);
// const float duree_impulsion = duty_cycle * period;
return duty_cycle;
}

View file

@ -3,21 +3,8 @@
#include "Timer.h"
/**
* @brief Configure le timer en PWM pour recevoir des données
* @note
* @param TIM_TypeDef timer : le timer à utiliser
* int channel : le channel du timer
* @retval None
*/
void RFReceiver_conf(TIM_TypeDef * timer, int channel);
/**
* @brief Lis les données envoyées à la PWM par le recepteur
* @note
* @param TIM_TypeDef timer : le timer à utiliser
* @retval la durée de l'impulsion
*/
float RFReceiver_getData(TIM_TypeDef * timer);
#endif

View file

@ -12,7 +12,7 @@
void Scheduler_conf(void (*it_callback) (void));
/**
* @brief Démarre l'ordonanceur
* @brief Démarre ordonanceur
* @note
* @param None
* @retval None

View file

@ -14,13 +14,7 @@ void ServoMotor_start(TIM_TypeDef * timer)
}
float convertAngleToDutyCycle(int angle) {
// fonction lineaire [0 - 90] -> [0.05 - 0.1]
return (float)angle / 1800.0 + 0.05;
}
int convertDutyCycleToAngle(float dutyCycle) {
// fonction lineaire [0.049 - 0.1] -> [0 - 90]
return (dutyCycle - 0.049) * 1800;
return ((float) angle) / 90.0 / 20 + 0.05;
}
void ServoMotor_setAngle(TIM_TypeDef * timer, int channel, int angle)
@ -31,5 +25,5 @@ void ServoMotor_setAngle(TIM_TypeDef * timer, int channel, int angle)
int ServoMotor_getAngle(TIM_TypeDef * timer, int channel)
{
const float dutyCycle = Timer_pwmo_getDutyCycle(timer, channel);
return convertDutyCycleToAngle(dutyCycle);
return 359 * dutyCycle;
}

View file

@ -6,7 +6,7 @@
#include "GPIO.h"
/**
* @brief Configure le timer PWM et le GPIO pour le servo moteur
* @brief Configure le servo moteur associé au timer donné
* @note
* @param TIM_TypeDef Timer : indique le timer à utiliser : TIM1, TIM2, TIM3 ou TIM4
* int channel : Le channel utilisé par le servo moteur
@ -17,7 +17,7 @@
void ServoMotor_conf(TIM_TypeDef * timer, int channel, GPIO_TypeDef * gpio, int pin);
/**
* @brief Démarre la PWM du servo moteur
* @brief Démarre les servo moteurs associés au timer donné
* @note
* @param TIM_TypeDef Timer : indique le timer à utiliser : TIM1, TIM2, TIM3 ou TIM4
* @retval None
@ -39,7 +39,7 @@ void ServoMotor_setAngle(TIM_TypeDef * timer, int channel, int angle);
* @note
* @param TIM_TypeDef Timer : indique le timer à utiliser : TIM1, TIM2, TIM3 ou TIM4
* int channel : Le channel utilisé par le servo moteur
* @retval L'angle en degrès
* @retval int angle
*/
int ServoMotor_getAngle(TIM_TypeDef * timer, int channel);

View file

@ -4,30 +4,10 @@
#include "ADC.h"
#include "GPIO.h"
/**
* @brief Configure le GPIO et l'ADC pour lire les données de la batterie
* @note
* @param ADC_TypeDef adc : l'ADC à utiliser
* GPIO_TypeDef gpio : le GPIO à utiliser
* int pin : le pin à utiliser
* @retval None
*/
void Voltage_conf(ADC_TypeDef * adc, GPIO_TypeDef * gpio, int pin);
/**
* @brief Démarre l'ADC pour lire les données de la batterie
* @note
* @param ADC_TypeDef adc : l'ADC à utiliser
* @retval None
*/
void Voltage_start(ADC_TypeDef * adc);
/**
* @brief Récupère la tension de la batterie
* @note
* @param ADC_TypeDef adc : l'ADC à utiliser
* @retval La tension
*/
float Voltage_getVoltage(ADC_TypeDef * adc, int channel);
#endif

View file

@ -5,12 +5,10 @@
#include "stdio.h"
#include "string.h"
// Composants utilisés par l'emetteur
USART_TypeDef * EMITTER_USART = USART1;
GPIO_TypeDef * EMITTER_GPIO = GPIOA;
const int EMITTER_PIN = LL_GPIO_PIN_11;
// Composants utilisés par la batterie
ADC_TypeDef * VOLTAGE_ADC = ADC2;
const int VOLTAGE_CHANNEL = 12;
GPIO_TypeDef * VOLTAGE_GPIO = GPIOC;
@ -28,6 +26,7 @@ void Display_start()
RFEmitter_start(EMITTER_USART);
}
void Display_background(int secCounter)
{
static int previousEmergencyState = 0;
@ -35,27 +34,20 @@ void Display_background(int secCounter)
const int emergency = Sail_getEmergencyState();
if (secCounter - prevSendSec == 1 || (emergency && !previousEmergencyState)) {
previousEmergencyState = emergency;
if (secCounter - prevSendSec == 3 || (emergency && !previousEmergencyState)) {
prevSendSec = secCounter;
const float voltage = Voltage_getVoltage(VOLTAGE_ADC, VOLTAGE_CHANNEL);
const int sailAngle = Sail_getSailAngle();
const int sailPercent = sailAngle * 100 / 90.0;
// const int relativeAngle = sailAngle >= 180 ? 360 - sailAngle : sailAngle;
// const int sailPercent = (90 - relativeAngle) * 100 / 90;
const int relativeAngle = sailAngle >= 180 ? 360 - sailAngle : sailAngle;
const int sailPercent = (90 - relativeAngle) * 100 / 90;
char displayStr[100];
sprintf(displayStr, "Bordage actuel = %d%%\nTension de la batterie = %fV\n", sailPercent, voltage);
if (emergency)
sprintf(displayStr, "Limite de roulis atteinte !\n%s", displayStr);
char displayStr[100] = "";
char emergStr[30] = "";
if (emergency) {
sprintf(emergStr, "Limite de roulis atteinte !\n\r");
RFEmitter_send(EMITTER_USART, emergStr, strlen(emergStr), EMITTER_GPIO, EMITTER_PIN);
}
sprintf(displayStr, "Angle de la voile : %ddeg\n\rBordage actuel = %d%% \n\rTension de la batterie = %fV \n\r\n\r", sailAngle, sailPercent, voltage);
RFEmitter_send(EMITTER_USART, displayStr, strlen(displayStr), EMITTER_GPIO, EMITTER_PIN);
}

View file

@ -1,29 +1,10 @@
#ifndef DISPLAY_H
#define DISPLAY_H
/**
* @brief Configure l'ADC de la batterie et le RFEmitter pour l'affichage
* @note
* @param None
* @retval None
*/
void Display_conf(void);
/**
* @brief Démarre l'ADC de la batterie et le RFEmitter
* @note
* @param None
* @retval None
*/
void Display_start(void);
/**
* @brief Envoie au pupitre toutes les 3 secondes le bordage et la tension de la batterie.
* Si jamais l'alarme de roulis est déclenchée, elle sera tout de suite envoyée au pupitre.
* @note
* @param secCounter : Nombre de secondes écoulées depuis le début du programme
* @retval None
*/
void Display_background(int secCounter);
void Display_background(int msCounter);
#endif

View file

@ -1,27 +1,23 @@
#include "Orientation.h"
#include "math.h"
const float THRESHOLD = 0.05;
#define THRESHOLD 0
const float MIN_DUTY_CYCLE = 0.05;
const float ZERO_DUTY_CYCLE = 0.075;
const float MAX_DUTY_CYCLE = 0.1;
// Recepteur
TIM_TypeDef * RECEIVER_TIMER = TIM4;
const int RECEIVER_CHANNEL = LL_TIM_CHANNEL_CH1;
// Moteur
TIM_TypeDef * DCMOTOR_TIMER = TIM2;
const int DCMOTOR_CHANNEL = LL_TIM_CHANNEL_CH2;
GPIO_TypeDef * DCMOTOR_GPIO = GPIOA;
const int DCMOTOR_PIN_PWM = LL_GPIO_PIN_1;
const int DCMOTOR_PIN_DIRECTION = LL_GPIO_PIN_2;
const int DCMOTOR_PIN = LL_GPIO_PIN_2;
void Orientation_conf()
{
DCMotor_conf(DCMOTOR_TIMER, DCMOTOR_CHANNEL, DCMOTOR_GPIO, DCMOTOR_PIN_PWM, DCMOTOR_GPIO, DCMOTOR_PIN_DIRECTION);
DCMotor_conf(DCMOTOR_TIMER, DCMOTOR_CHANNEL, DCMOTOR_GPIO, DCMOTOR_PIN);
RFReceiver_conf(RECEIVER_TIMER, LL_TIM_CHANNEL_CH1);
}
@ -29,12 +25,13 @@ void Orientation_background()
{
const float duty_cycle = RFReceiver_getData(RECEIVER_TIMER);
// Calcul de la vitesse du moteur (entre 0 et 1)
const float speed = (duty_cycle - ZERO_DUTY_CYCLE) / (MAX_DUTY_CYCLE - ZERO_DUTY_CYCLE);
// On ne demarre le moteur que si la vitesse depasse un certain seuil
if (fabs(speed) > THRESHOLD)
DCMotor_setSpeed(DCMOTOR_TIMER, DCMOTOR_CHANNEL, DCMOTOR_GPIO, DCMOTOR_PIN_DIRECTION, speed);
else
DCMotor_setSpeed(DCMOTOR_TIMER, DCMOTOR_CHANNEL, DCMOTOR_GPIO, DCMOTOR_PIN_DIRECTION, 0);
//Si la vitesse (en valeur absolue) ne dépasse pas un certain seuil, on ne démarre pas le moteur
if (THRESHOLD > fabs(speed)) {
DCMotor_setSpeed(DCMOTOR_TIMER, DCMOTOR_CHANNEL, DCMOTOR_GPIO, DCMOTOR_PIN, 0);
}
else {
DCMotor_setSpeed(DCMOTOR_TIMER, DCMOTOR_CHANNEL, DCMOTOR_GPIO, DCMOTOR_PIN, speed);
}
}

View file

@ -4,20 +4,8 @@
#include "DCMotor.h"
#include "RFReceiver.h"
/**
* @brief Configure le moteur continu et le RFReceiver pour l'orientation du voilier
* @note
* @param None
* @retval None
*/
void Orientation_conf(void);
/**
* @brief Récupère la vitesse demandée par l'utilisateur et la transmets au moteur DC
* @note
* @param None
* @retval None
*/
void Orientation_background(void);
#endif

View file

@ -29,19 +29,14 @@ int Roll_getEmergencyState(void)
return Roll_isEmergencyState;
}
int current = 0;
int angle= 0;
void Roll_background(void)
{
// const int xAngle = Accelerometer_getAngle(ROLL_ADC, ROLL_X_CHANNEL);
const int yAngle = Accelerometer_getAngle(ROLL_ADC, ROLL_Y_CHANNEL);
angle = yAngle;
const int xAngle = Accelerometer_getAngle(ROLL_ADC, ROLL_Y_CHANNEL);
//const int yAngle = Accelerometer_getAngle(ROLL_ADC, ROLL_Y_CHANNEL);
const int currentState = Roll_isEmergencyState ? abs(yAngle) >= 10 : abs(yAngle) >= 40;
current = currentState;
if (Roll_isEmergencyState != currentState) {
Sail_setEmergency(currentState);
Roll_isEmergencyState = currentState;
}
const int currentState = abs(xAngle) >= 40;
if (Roll_isEmergencyState && !currentState)
Sail_setEmergency(1);
else if (!Roll_isEmergencyState && currentState)
Sail_setEmergency(0);
}

View file

@ -1,36 +1,12 @@
#ifndef ROLL_H
#define ROLL_H
/**
* @brief Configure l'accelerometre pour la détection de roulis
* @note
* @param None
* @retval None
*/
void Roll_conf(void);
/**
* @brief Démarre l'accelerometre pour la détection de roulis
* @note
* @param None
* @retval None
*/
void Roll_start(void);
/**
* @brief Récupère l'état d'alarme de dépassement de roulis
* @note
* @param None
* @retval 1 si l'alarme est active, 0 sinon
*/
int Roll_getEmergencyState(void);
/**
* @brief Récupère l'angle de roulis et déclenche l'alarme si il dépasse le seuil autorisé
* @note
* @param None
* @retval None
*/
void Roll_background(void);
#endif

View file

@ -11,7 +11,7 @@ TIM_TypeDef * ENCODER_TIMER = TIM3;
GPIO_TypeDef * ENCODER_GPIO = GPIOA;
const int ENCODER_PIN = LL_GPIO_PIN_5;
const int RESET_ANGLE = 0;
const int RESET_ANGLE = 90;
int Sail_isEmergencyState = 0;
@ -41,17 +41,6 @@ int Sail_getSailAngle(void)
return ServoMotor_getAngle(MOTOR_TIMER, MOTOR_CHANNEL);
}
void Sail_setEmergency(int state)
{
Sail_isEmergencyState = state;
if (Sail_isEmergencyState)
ServoMotor_setAngle(MOTOR_TIMER, MOTOR_CHANNEL, RESET_ANGLE);
}
int Sail_getEmergencyState()
{
return Sail_isEmergencyState;
}
void Sail_background()
{
@ -65,3 +54,15 @@ void Sail_background()
else
ServoMotor_setAngle(MOTOR_TIMER, MOTOR_CHANNEL, windToSailAngle(windAngle));
}
void Sail_setEmergency(int state)
{
Sail_isEmergencyState = state;
if (Sail_isEmergencyState)
ServoMotor_setAngle(MOTOR_TIMER, MOTOR_CHANNEL, RESET_ANGLE);
}
int Sail_getEmergencyState()
{
return Sail_isEmergencyState;
}

View file

@ -2,7 +2,7 @@
#define SAIL_H
/**
* @brief Configure le servo moteur et le codeur incrémental pour la manipulation de la voile
* @brief Configure la voile
* @note
* @param None
* @retval None
@ -10,44 +10,31 @@
void Sail_conf(void);
/**
* @brief Démarre le servo moteur et le codeur incrémental pour la manipulation de la voile
* @note
* @param None
* @retval None
*/
void Sail_start(void);
/**
* @brief Active le mode urgence des voiles pour les détendre
* @note
* @param None
* @retval None
*/
void Sail_setEmergency(int state);
/**
* @brief Retourne l'état d'alarme de la voile
* @note
* @param None
* @retval 1 si l'alarme est active, 0 sinon
*/
int Sail_getEmergencyState(void);
/**
* @brief Retourne l'angle du servo moteur de la voile
* @note
* @param None
* @retval angle en degrès entre 0 (tendu) et 90 (détendu)
*/
int Sail_getSailAngle(void);
/**
* @brief Ajuste l'angle du servo moteur de la voile en fonction de l'angle du vent capté par la girouette
* @brief Execute la tache de fond des voiles en fonction des valeurs récupérées par les drivers
* @note
* @param None
* @retval None
*/
void Sail_background(void);
/**
* @brief Mets la voile à 90 degres
* @note
* @param None
* @retval None
*/
void Sail_setEmergency(int state);
int Sail_getEmergencyState(void);
int Sail_getSailAngle(void);
/**
* @brief Réinitialise la voile à sa position initiale
* @note
* @param None
* @retval None
*/
void Sail_start(void);
#endif

View file

@ -26,26 +26,20 @@
#include "Orientation.h"
#include "Scheduler.h"
#include "ADC.h"
#include "GPIO.h"
#include "Accelerometer.h"
#include "RFEmitter.h"
#include "stdio.h"
void SystemClock_Config(void);
// Compteur de secondes
int secCounter = 0;
/* Private functions ---------------------------------------------------------*/
/**
* @brief Effectue la tache de fond (programmee toutes les ms)
* @note
* @param None
* @retval None
*/
void backgroundTask()
{
// Compte les millisecondes et secondes
static int msCounter;
msCounter++;
if (msCounter == 1000) {
@ -57,12 +51,6 @@ void backgroundTask()
Orientation_background();
}
/**
* @brief Configure les peripheriques
* @note
* @param None
* @retval None
*/
void configurePeripherals()
{
Sail_conf();
@ -71,12 +59,6 @@ void configurePeripherals()
Orientation_conf();
}
/**
* @brief Demarre les peripheriques
* @note
* @param None
* @retval None
*/
void startPeripherals()
{
Sail_start();
@ -102,7 +84,7 @@ int main(void)
Scheduler_start();
while (1) {
Display_background(secCounter);
// Display_background(secCounter);
}
@ -150,7 +132,7 @@ void SystemClock_Config(void)
/* Enable HSE oscillator */
// ********* Commenter la ligne ci-dessous pour MCBSTM32 *****************
// ********* Conserver la ligne si Nucleo*********************************
// ********* Conserver la ligne si Nucléo*********************************
// LL_RCC_HSE_EnableBypass();
LL_RCC_HSE_Enable();
while(LL_RCC_HSE_IsReady() != 1)