{"id":3043,"date":"2024-09-21T05:21:35","date_gmt":"2024-09-21T05:21:35","guid":{"rendered":"https:\/\/iotthinghub.com\/?p=3043"},"modified":"2024-09-21T06:47:25","modified_gmt":"2024-09-21T06:47:25","slug":"pwm-small-radar","status":"publish","type":"post","link":"https:\/\/iotthinghub.com\/?p=3043","title":{"rendered":"PWM : Small Radar"},"content":{"rendered":"\n

In this article we interface servo motor & use ultrasonic sensor to detect small object. In our case the servo motor will rotate 450<\/sup> in each step and ultrasonic sensor detects any object nearby. Before start first go through my servo motor control<\/a> & ultrasonic sensor<\/a> article. In our basic timer part we learn about prescaler & counter period (ARR). For servo motor we need 50Hz frequency signal. In this article we use system clock as 48MHz internal clock. For PWM the formula is-<\/p>\n\n\n\n

\u00a0\u00a0\u00a0\u00a0 PWM frequency fPWM<\/sub> = fcpu<\/sub>\/((1+Prescaler)*(1+ARR)) <\/p>\n\n\n\n

Let ARR=19999 then Prescaler will be 47. It will generate 20ms wave signal. Servo motor works on duty cycle. The CCRx register of timer determine the duty cycle. So if we went to generate .025% duty cycle, the CCRx register value will be (0.025*(1+ARR)-1) = (0.025*(1+19999)-1)=499. For every rotation the CCRx value will be-<\/p>\n\n\n\n

\"\"<\/figure>\n\n\n\n

Here I use TIM1 Channel 1 as PWM timer PIN, so for each direction our desire value will be-<\/p>\n\n\n\n

\"\"<\/figure>\n\n\n\n

Every 450<\/sup> change cycle we need some delay function for the servo motor to change position. If we use HAL_delay function the system clock will halt and no farther execution. In our case we use system clock as delay function. In every direction we measure the distance using ultrasonic sensor. For interfacing ultrasonic sensor we need an EXIT pin & GPIO pin. Since for our delay function we use system clock, in ultrasonic sensor Trigger pin we use system delay function as follow-<\/p>\n\n\n

\n  HAL_GPIO_WritePin(GPIOC,GPIO_PIN_9,GPIO_PIN_SET);\n  for(uint16_t i=0;i<780;i++)\n  __ASM volatile ("NOP");     \/\/F_CPU=48MHz and every cycle 0.020833us time \n  HAL_GPIO_WritePin(GPIOC,GPIO_PIN_9,GPIO_PIN_RESET);\n<\/pre><\/div>\n\n\n
Here we use assembly language NOP (No Operation ) function for delay & GPIOC Pin 9 as trig pin. When we trigger the trig pin of ultrasonic sensor, it send 8cycle ultrasonic burst. The ECHO pin will go high and remain high until an ultrasonic burst is detecting back. Since sound wave travels at 3.43m\/s, we need timer to calculate time. We use TIM17 for time count. Set prescaler value 47 & counter period (ARR) 65535, so every pulse will be 1us. In our previous IR Decode principle we learn about pulse detection using EXIT. Initialize EXIT with rising\/falling edge detection. In rising pulse start the counter & at falling edge stop the counter.<\/p>\n\n\n\n
\"\"<\/figure>\n\n\n\n
The pulse detection program as follow-<\/p>\n\n\n
\nextern TIM_HandleTypeDef htim17;\nif(flag)\n  {\n    pulse_width=TIM17 -> CNT ;\n    pulse_width=pulse_width\/200; \/\/ since it reflect\n    distance=(3.43*pulse_width); \/\/ Distance in cm  \n    switch(direction)\n    {\n        case 1: sprintf(display_direction,"West:%.2fcm   ",distance);\n        OLCD_write_string(2,0,display_direction);\n        break;\n        case 2: sprintf(display_direction,"SW:%.2fcm    ",distance);\n        OLCD_write_string(2,0,display_direction);\n        break;\n        case 3: sprintf(display_direction,"South:%.2fcm  ",distance);\n        OLCD_write_string(2,0,display_direction);\n        break;\n        case 4: sprintf(display_direction,"WE:%.2fcm   ",distance);\n        OLCD_write_string(2,0,display_direction);\n        break;\n        case 0: sprintf(display_direction,"East:%.2fcm   ",distance);\n        OLCD_write_string(2,0,display_direction);\n        break;\n    }\n    TIM17->CNT=0;\n    flag=0;\n  }\nelse\n  {\n   HAL_TIM_Base_Start(&htim17);\n   flag=1;\n   TIM17->CNT=0;\n  }\n<\/pre><\/div>\n\n\n
Here we use I2<\/sup>C1 for 0.91″ OLED for display. For controlling servo motor & ultrasonic sensor trigger we use another timer in this case. In my case I use TIM16 for schedule servo motor & ultrasonic sensor. Setting for TIM16 as prescaler 4799 & Counter Period (ARR) 65535, so frequency of TIM16 is-<\/p>\n\n\n\n
         \u00a0Frequency of TIM16 fTIM16<\/sub> = 48MHz\/(1+4799) = 10kHz\u00a0\u00a0\u00a0 or TTIM16 <\/sub>= 0.1ms<\/p>\n\n\n\n
So that Timer Interrupt occurs at every Tint <\/sub>= 0.1ms*65535 = 6.5535s. Enable global Interrupt for TIM16 & in TIM16 interrupt service routine the coding as follow-<\/p>\n\n\n
\nswitch(direction)\n    {\n        case 0: TIM1->CCR1=499;      \/\/ West side\n\t    for(uint16_t j=0;j<8000;j++)\n         for(uint16_t i=0;i<4800;i++)   \/\/ .8s\n          __ASM volatile ("NOP");   \/\/ F_CPU=48MHz and every cycle 0.020833us time \n        break;\n        case 1: TIM1->CCR1=999;     \/\/ South-West side\n        break;\n        case 2: TIM1->CCR1=1499;    \/\/ South side\n        break;\n        case 3: TIM1->CCR1=1999;    \/\/ South-East side\n        break;\n        case 4: TIM1->CCR1=2499;    \/\/ East side\n        break;\n    }\n\tfor(uint16_t j=0;j<8000;j++)\n     for(uint16_t i=0;i<480;i++)   \/\/ 80ms\n         __ASM volatile ("NOP");   \/\/ F_CPU=48MHz and every cycle 0.020833us time \n  direction++;\n  if(direction>=5) direction=0;    \n  \/******             Ultrasonic Sensor Function               ******************\/\n  HAL_GPIO_WritePin(GPIOC,GPIO_PIN_9,GPIO_PIN_SET);\n  for(uint16_t i=0;i<780;i++)\n  __ASM volatile ("NOP");     \/\/F_CPU=48MHz and every cycle 0.020833us time \n  HAL_GPIO_WritePin(GPIOC,GPIO_PIN_9,GPIO_PIN_RESET); \n  \/******************************************************************************\/\n<\/pre><\/div>\n\n\n
Every 6.5535s the Timer 16 generates an interrupt and PWM frequency would change & trig pin of ultrasonic sensor would activate. Here we use system clock as delay function. For every frequency change the servo motor need some time to reach destination. All coding has done in stm32f0xx_it.c file. In main program file is just initialization.<\/p>\n\n\n
\n#include "ssd1306.h"\nHAL_TIM_PWM_Start(&htim1,TIM_CHANNEL_1); \/\/ PWM start for channel 1 TIM1\nHAL_TIM_Base_Start_IT(&htim16); \/\/ Global interrupt for TIM16\ninit_OLED();\nclear_display();\nOLCD_write_string(0,0,"Small Rader");\nwhile(1){\n}\n<\/pre><\/div>\n\n\n
Some useful function of PWM-<\/p>\n\n\n
\nHAL_TIM_PWM_Start(TIM_HandleTypeDef *htim, uint32_t Channel);\nHAL_TIM_PWM_Stop(TIM_HandleTypeDef *htim, uint32_t Channel);\nHAL_TIM_PWM_Start_IT(TIM_HandleTypeDef *htim, uint32_t Channel);\nHAL_TIM_PWM_Stop_IT(TIM_HandleTypeDef *htim, uint32_t Channel);\nHAL_TIM_PWM_Start_DMA(TIM_HandleTypeDef *htim, uint32_t Channel, const uint32_t *pData,uint16_t Length);\nHAL_TIM_PWM_Stop_DMA(TIM_HandleTypeDef *htim, uint32_t Channel);\n<\/pre><\/div>\n\n\n
\n