欧美人与善交大片,500国内福利第一导航,精品衣服全部都没有

#include "sys.h"
#include "delay.h"
#include "usart.h"
#include "usart2.h"
#include "includes.h"
#include "timer.h"
#include "led.h"
#define START_TASK_PRIO 3
#define START_STK_SIZE 128
OS_TCB StartTaskTCB;
CPU_STK START_TASK_STK[START_STK_SIZE];
void start_task(void *p_arg);
#define TASK1_TASK_PRIO 4
#define TASK1_STK_SIZE 128
OS_TCB Task1_TaskTCB;
CPU_STK TASK1_TASK_STK[TASK1_STK_SIZE];
void task1_task(void *p_arg);
#define TASK2_TASK_PRIO 5
#define TASK2_STK_SIZE 128
OS_TCB Task2_TaskTCB;
CPU_STK TASK2_TASK_STK[TASK2_STK_SIZE];
void task2_task(void *p_arg);
#define TASK3_TASK_PRIO 6
#define TASK3_STK_SIZE 128
OS_TCB Task3_TaskTCB;
CPU_STK TASK3_TASK_STK[TASK3_STK_SIZE];
void task3_task(void *p_arg);
#define TASK4_TASK_PRIO 7
#define TASK4_STK_SIZE 128
OS_TCB Task4_TaskTCB;
CPU_STK TASK4_TASK_STK[TASK4_STK_SIZE];
void task4_task(void *p_arg);
//主函數(shù)
int main(void)
{
OS_ERR err;
CPU_SR_ALLOC();
//模塊初始化
delay_init(); //時鐘初始化
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//中斷分組配置
uart_init(115200); //串口初始化
//Usart3_Init();
//USART_SendData(USART3,5);
//LED_Init(); //LED初始化
Servo_Init();
Motor_Init();
Timer4_Init(); //1kHz 1ms中斷一次
Bsp_Int_Ok = 1;
//初始化完成
Servo_Out(750,750,750,750);
OSInit(&err); //初始化UCOSIII
OS_CRITICAL_ENTER(); //進入臨界區(qū)
//創(chuàng)建開始任務(wù)
OSTaskCreate((OS_TCB * )&StartTaskTCB, //任務(wù)控制塊
(CPU_CHAR * )"start task", //任務(wù)名字
(OS_TASK_PTR )start_task, //任務(wù)函數(shù)
(void * )0, //傳遞給任務(wù)函數(shù)的參數(shù)
(OS_PRIO )START_TASK_PRIO, //任務(wù)優(yōu)先級
(CPU_STK * )&START_TASK_STK[0], //任務(wù)堆棧基地址
(CPU_STK_SIZE)START_STK_SIZE/10, //任務(wù)堆棧深度限位
(CPU_STK_SIZE)START_STK_SIZE, //任務(wù)堆棧大小
(OS_MSG_QTY )0, //任務(wù)內(nèi)部消息隊列能夠接收的最大消息數(shù)目,為0時禁止接收消息
(OS_TICK )0, //當(dāng)使能時間片輪轉(zhuǎn)時的時間片長度，為0時為默認(rèn)長度，
(void * )0, //用戶補充的存儲區(qū)
(OS_OPT )OS_OPT_TASK_STK_CHK|OS_OPT_TASK_STK_CLR, //任務(wù)選項
(OS_ERR * )&err); //存放該函數(shù)錯誤時的返回值
OS_CRITICAL_EXIT(); //退出臨界區(qū)
OSStart(&err); //開啟UCOSIII
}
//開始任務(wù)任務(wù)函數(shù)
void start_task(void *p_arg)
{
OS_ERR err;
CPU_SR_ALLOC();
p_arg = p_arg;
CPU_Init();
#if OS_CFG_STAT_TASK_EN > 0u
OSStatTaskCPUUsageInit(&err); //統(tǒng)計任務(wù)
#endif
#ifdef CPU_CFG_INT_DIS_MEAS_EN //如果使能了測量中斷關(guān)閉時間
CPU_IntDisMeasMaxCurReset();
#endif
#if OS_CFG_SCHED_ROUND_ROBIN_EN //當(dāng)使用時間片輪轉(zhuǎn)的時候
//使能時間片輪轉(zhuǎn)調(diào)度功能,時間片長度為1個系統(tǒng)時鐘節(jié)拍，既1*5=5ms
OSSchedRoundRobinCfg(DEF_ENABLED,1,&err);
#endif
OS_CRITICAL_ENTER(); //進入臨界區(qū)
//創(chuàng)建TASK1任務(wù)
OSTaskCreate((OS_TCB * )&Task1_TaskTCB,
(CPU_CHAR * )"Task1 task",
(OS_TASK_PTR )task1_task,
(void * )0,
(OS_PRIO )TASK1_TASK_PRIO,
(CPU_STK * )&TASK1_TASK_STK[0],
(CPU_STK_SIZE)TASK1_STK_SIZE/10,
(CPU_STK_SIZE)TASK1_STK_SIZE,
(OS_MSG_QTY )0,
(OS_TICK )0,
(void * )0,
(OS_OPT )OS_OPT_TASK_STK_CHK|OS_OPT_TASK_STK_CLR,
(OS_ERR * )&err);
//創(chuàng)建TASK2任務(wù)
OSTaskCreate((OS_TCB * )&Task2_TaskTCB,
(CPU_CHAR * )"task2 task",
(OS_TASK_PTR )task2_task,
(void * )0,
(OS_PRIO )TASK2_TASK_PRIO,
(CPU_STK * )&TASK2_TASK_STK[0],
(CPU_STK_SIZE)TASK2_STK_SIZE/10,
(CPU_STK_SIZE)TASK2_STK_SIZE,
(OS_MSG_QTY )0,
(OS_TICK )0,
(void * )0,
(OS_OPT )OS_OPT_TASK_STK_CHK|OS_OPT_TASK_STK_CLR,
(OS_ERR * )&err);
//創(chuàng)建TASK3任務(wù)
OSTaskCreate((OS_TCB * )&Task3_TaskTCB,
(CPU_CHAR * )"task3 task",
(OS_TASK_PTR )task3_task,
(void * )0,
(OS_PRIO )TASK3_TASK_PRIO,
(CPU_STK * )&TASK3_TASK_STK[0],
(CPU_STK_SIZE)TASK3_STK_SIZE/10,
(CPU_STK_SIZE)TASK3_STK_SIZE,
(OS_MSG_QTY )0,
(OS_TICK )0,
(void * )0,
(OS_OPT )OS_OPT_TASK_STK_CHK|OS_OPT_TASK_STK_CLR,
(OS_ERR * )&err);
//創(chuàng)建TASK4任務(wù)
OSTaskCreate((OS_TCB * )&Task4_TaskTCB,
(CPU_CHAR * )"task4 task",
(OS_TASK_PTR )task4_task,
(void * )0,
(OS_PRIO )TASK4_TASK_PRIO,
(CPU_STK * )&TASK4_TASK_STK[0],
(CPU_STK_SIZE)TASK4_STK_SIZE/10,
(CPU_STK_SIZE)TASK4_STK_SIZE,
(OS_MSG_QTY )0,
(OS_TICK )0,
(void * )0,
(OS_OPT )OS_OPT_TASK_STK_CHK|OS_OPT_TASK_STK_CLR,
(OS_ERR * )&err);
OS_CRITICAL_EXIT(); //退出臨界區(qū)
OSTaskDel((OS_TCB*)0,&err); //刪除start_task任務(wù)自身
}
u16 len = 0;
u16 t = 0;
//task1任務(wù)函數(shù)
void task1_task(void *p_arg)
{
OS_ERR err;
err = err;
p_arg = p_arg;
while(1)
{
if( Count_10ms >= 10 )
{
Count_10ms = 0;
}
if( Count_20ms >= 20 )
{
Count_20ms = 0;
/*
error = error_get;
val_out = Kp * error + Kd*(error-error_last);
error_last = error;
Servo_PWM = val_out + 750;
TIM2->CCR2 = Servo_PWM;
*/
}
if( Count_40ms >= 40 )
{
Count_40ms = 0;
if( USART_RX_STA & 0x8000 )
{
len=USART_RX_STA&0x3fff;//得到此次接收到的數(shù)據(jù)長度
//printf("\r\n your message:\r\n");
for(t=0;t<len;t++)
{
USART1->DR=USART_RX_BUF[t];
while((USART1->SR&0X40)==0);//等待發(fā)送結(jié)束
}
//printf("\r\n");//插入換行
USART_RX_STA=0;
}
}
}
}
//task2任務(wù)函數(shù)
void task2_task(void *p_arg)
{
u8 task2_num=0;
OS_ERR err;
p_arg = p_arg;
while(1)
{
task2_num++; //任務(wù)2執(zhí)行次數(shù)加1 注意task1_num2加到255的時候會清零！！
//printf("task2 runs;%dtimes\r\n",task2_num);
OSTimeDlyHMSM(0,0,2,0,OS_OPT_TIME_HMSM_STRICT,&err); //延時1s
}
}
//task3任務(wù)函數(shù)
void task3_task(void *p_arg)
{
u8 task3_num=0;
OS_ERR err;
p_arg = p_arg;
while(1)
{
task3_num++; //任務(wù)2執(zhí)行次數(shù)加1 注意task1_num2加到255的時候會清零！！
//printf("task3 runs;%dtimes\r\n",task3_num);
OSTimeDlyHMSM(0,0,3,0,OS_OPT_TIME_HMSM_STRICT,&err); //延時1s
}
}
//task4任務(wù)函數(shù)
void task4_task(void *p_arg)
{
u8 task4_num=0;
OS_ERR err;
p_arg = p_arg;
while(1)
{
task4_num++; //任務(wù)2執(zhí)行次數(shù)加1 注意task1_num2加到255的時候會清零！！
//printf("task4 runs;%dtimes\r\n",task4_num);
OSTimeDlyHMSM(0,0,4,0,OS_OPT_TIME_HMSM_STRICT,&err); //延時1s
}
}

復(fù)制代碼

欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136