久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费
標題:
control step servor
[打印本頁]
作者:
ngoluc
時間:
2021-9-2 11:08
標題:
control step servor
kiểm soát demo bước Servor
/* Includes ------------------------------------------------------------------*/
#include "main.h"
#include "uart.h"
#include "control.h"
/* Private function prototypes -----------------------------------------------*/
void SystemClock_Config(void);
int main(void)
{
/* Reset of all peripherals, Initializes the Flash interface and the Systick. */
HAL_Init();
SystemClock_Config();
/* Initialize all configured peripherals */
MX_GPIO_Init();
MX_USART1_UART_Init();
MX_USART2_UART_Init();
/* USER CODE BEGIN 2 */
HAL_UART_Receive_IT(&huart2, (uint8_t*) &UART1_Data, 1);
/* USER CODE END 2 */
DWT_Delay_Init();
while (1)
{
if(UART_Buffer[0]!=0){
sprintf(copy,"%s\r\n", UART_Buffer);
cpystr(&chuoi[0],substr(©[0],0,0));
printf("%s\r\n",&chuoi[0]);
home=chuoi[0];
// ta=atoi(&n[0]);
cpystr(&chuoi[1],substr(©[1],7,7));
printf("%s\r\n",&chuoi[1]);
// svong=atoi(&chuoi[1]);
cpystr(&chuoi[2],substr(©[2],9,9));
printf("%s\r\n",&chuoi[2]);
// dir=atoi(&chuoi[2]);
HAL_Delay(700);
if(copy[0]>0&&chuoi[0]>0){
for(int h=0;h<100;h++){
copy[h]=0;
chuoi[h]=0;
}
for(int p=0;p<100;p++){
UART_Buffer[p]=0;
}
}
}
HAL_Delay(500);
//=====================================================================================================
if(home=='h'){
if(HAL_GPIO_ReadPin(STOP3_GPIO_Port,STOP3_Pin)==1&&HAL_GPIO_ReadPin(STOP2_GPIO_Port,STOP2_Pin)==1){
dc2(phai,1,100); // lui ve
}
else{
stopdc2();
}
if(HAL_GPIO_ReadPin(STOP3_GPIO_Port,STOP3_Pin)==1&&HAL_GPIO_ReadPin(STOP2_GPIO_Port,STOP2_Pin)==0){
dc2(phai,1,100); // lui ve
}
else{
stopdc2();
}
if(HAL_GPIO_ReadPin(STOP2_GPIO_Port,STOP2_Pin)==1&&HAL_GPIO_ReadPin(STOP3_GPIO_Port,STOP3_Pin)==0){
dc1(trai,1,100); // lui ve
}
else{
stopdc1();
}
if (HAL_GPIO_ReadPin(STOP2_GPIO_Port,STOP2_Pin)==0&&HAL_GPIO_ReadPin(STOP3_GPIO_Port,STOP3_Pin)==0){
stopdc1();
stopdc2();
home=0;
}
}
else{
stopdc1();
stopdc2();
}
//=================================================================================================================
if(home=='r'){
if(HAL_GPIO_ReadPin(STOP2_GPIO_Port,STOP2_Pin)==0 && HAL_GPIO_ReadPin(STOP3_GPIO_Port,STOP3_Pin)==0)
{
dc2(trai,7,40);
if(HAL_GPIO_ReadPin(STOP2_GPIO_Port,STOP2_Pin)==0){
for(int k =0 ; k<9 ;k ++){
vitriy(phai,20,50);
HAL_Delay(700);
}
dc2(trai,3,40);
for(int lo =0 ; lo<9 ;lo++){
vitriy(trai,20,50);
HAL_Delay(700);
}
dc2(trai,3,40);
for(int m =0 ; m<9 ;m ++){
vitriy(phai,20,50);
HAL_Delay(700);
}
for(int dd =0 ; dd<9 ;dd ++){
vitriy(trai,20,50);
}
if(HAL_GPIO_ReadPin(STOP2_GPIO_Port,STOP2_Pin)==0){
stopdc1();
dc2(phai,5,40);
dc2(phai,3,70);
dc2(phai,3,90);
runx(100,2200);
}
else{
stopdc2();
}
if(HAL_GPIO_ReadPin(STOP2_GPIO_Port,STOP2_Pin)==0&&HAL_GPIO_ReadPin(STOP3_GPIO_Port,STOP3_Pin)==0){
HAL_Delay(500);
stopdc2();
stopdc1();
home=0;
}
}
}
}
else{
stopdc1();
stopdc2();
}
//==========================================================================================
}
}
void SystemClock_Config(void)
{
RCC_OscInitTypeDef RCC_OscInitStruct = {0};
RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};
/** Initializes the CPU, AHB and APB busses clocks
*/
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
RCC_OscInitStruct.HSEPredivValue = RCC_HSE_PREDIV_DIV1;
RCC_OscInitStruct.HSIState = RCC_HSI_ON;
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL9;
if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
{
Error_Handler();
}
/** Initializes the CPU, AHB and APB busses clocks
*/
RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;
if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
{
Error_Handler();
}
}
void Error_Handler(void)
{
/* USER CODE BEGIN Error_Handler_Debug */
/* User can add his own implementation to report the HAL error return state */
/* USER CODE END Error_Handler_Debug */
}
#ifdef USE_FULL_ASSERT
/**
* @brief Reports the name of the source file and the source line number
* where the assert_param error has occurred.
* @param file: pointer to the source file name
* @param line: assert_param error line source number
* @retval None
*/
void assert_failed(uint8_t *file, uint32_t line)
{
/* USER CODE BEGIN 6 */
/* User can add his own implementation to report the file name and line number,
tex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
/* USER CODE END 6 */
}
#endif /* USE_FULL_ASSERT */
復制代碼
control.7z
2021-9-2 15:42 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
253.49 KB, 下載次數: 3, 下載積分: 黑幣 -5
歡迎光臨 (http://m.zg4o1577.cn/bbs/)
Powered by Discuz! X3.1
主站蜘蛛池模板:
色片在线观看
|
97视频在线免费观看
|
触手繁殖の地狱3d啪啪
|
天天碰天天操
|
日韩成人免费视频
|
欧美一级黄色大片
|
激情婷婷综合
|
免费看v片
|
欧美精品亚洲精品
|
真实人妻互换毛片视频
|
av自拍偷拍
|
欧美精品一区在线观看
|
一区二区三区免费
|
亚洲人精品
|
国产精品久久久久久久久久
|
午夜国产视频
|
3d动漫精品h区xxxxx区
|
男男成人高潮片免费网站
|
草逼视频免费看
|
精品视频在线播放
|
黄a视频
|
一级做a视频
|
xxx免费视频
|
国产美女自拍视频
|
国产美女视频网站
|
日韩精品一区二区三区免费视频
|
亚洲精品字幕在线观看
|
日韩免费观看视频
|
亚洲成人黄色
|
中文字幕在线视频观看
|
成人免费毛片片v
|
热久久久久
|
少妇av在线
|
免费看黄色av
|
日韩视频免费看
|
天天撸夜夜操
|
国产又黄又爽
|
麻豆久久久
|
免费看黄色小视频
|
成人三级在线观看
|
国产高清网站
|