2025-11-10 18:05:11 +08:00
|
|
|
/*
|
|
|
|
|
* Copyright (c) 2021, Texas Instruments Incorporated
|
|
|
|
|
* All rights reserved.
|
|
|
|
|
*
|
|
|
|
|
* Redistribution and use in source and binary forms, with or without
|
|
|
|
|
* modification, are permitted provided that the following conditions
|
|
|
|
|
* are met:
|
|
|
|
|
*
|
|
|
|
|
* * Redistributions of source code must retain the above copyright
|
|
|
|
|
* notice, this list of conditions and the following disclaimer.
|
|
|
|
|
*
|
|
|
|
|
* * Redistributions in binary form must reproduce the above copyright
|
|
|
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
|
|
|
* documentation and/or other materials provided with the distribution.
|
|
|
|
|
*
|
|
|
|
|
* * Neither the name of Texas Instruments Incorporated nor the names of
|
|
|
|
|
* its contributors may be used to endorse or promote products derived
|
|
|
|
|
* from this software without specific prior written permission.
|
|
|
|
|
*
|
|
|
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
|
|
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
|
|
|
|
|
* THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
|
|
|
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
|
|
|
|
|
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
|
|
|
|
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
|
|
|
|
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
|
|
|
|
|
* OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
|
|
|
|
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
|
|
|
|
|
* OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
|
|
|
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
#include "ti_msp_dl_config.h"
|
2025-11-13 15:16:24 +08:00
|
|
|
#include "delay.h"
|
|
|
|
|
#include "mt6701.h"
|
|
|
|
|
#include "dfoc.h"
|
2025-11-10 18:05:11 +08:00
|
|
|
#include <stdio.h>
|
|
|
|
|
#include <string.h>
|
2025-11-12 19:44:11 +08:00
|
|
|
#include <pwm.h>
|
2025-11-13 15:16:24 +08:00
|
|
|
#include "config.h"
|
|
|
|
|
|
2025-11-10 18:05:11 +08:00
|
|
|
|
|
|
|
|
extern float angle_f;
|
|
|
|
|
|
2025-11-13 15:16:24 +08:00
|
|
|
extern bool gIsI2cError;
|
|
|
|
|
|
2025-11-10 18:05:11 +08:00
|
|
|
const float num_f = 0.123456f;
|
|
|
|
|
|
2025-11-12 19:44:11 +08:00
|
|
|
volatile uint16_t count = 0 ;
|
2025-11-13 22:00:00 +08:00
|
|
|
const float Target = 10; //串口目标值
|
2025-11-12 19:44:11 +08:00
|
|
|
|
2025-11-10 18:22:44 +08:00
|
|
|
|
2025-11-13 22:00:00 +08:00
|
|
|
const int pp = 7; //电机极对数
|
|
|
|
|
const int Dir = -1; //电机编码器方向
|
2025-11-12 21:26:40 +08:00
|
|
|
|
2025-11-10 18:05:11 +08:00
|
|
|
int main(void)
|
|
|
|
|
{
|
|
|
|
|
SYSCFG_DL_init();
|
|
|
|
|
NVIC_EnableIRQ(UART_0_INST_INT_IRQN);
|
2025-11-12 10:32:45 +08:00
|
|
|
DL_TimerA_startCounter(PWM_0_INST);
|
2025-11-13 22:00:00 +08:00
|
|
|
FOC_Init(12.6);
|
|
|
|
|
DL_SYSTICK_resetValue();
|
|
|
|
|
|
2025-11-13 15:16:24 +08:00
|
|
|
while(1)
|
|
|
|
|
{
|
|
|
|
|
DL_GPIO_togglePins(LED_PORT, LED_PA0_PIN);
|
|
|
|
|
//delay_ms(10);
|
|
|
|
|
|
2025-11-13 22:00:00 +08:00
|
|
|
if(DEBUG_ENABLED)
|
|
|
|
|
{
|
|
|
|
|
//volatile float angle_rad = GetAngle();
|
|
|
|
|
//printf("angle %.5f \n", angle_rad);
|
|
|
|
|
}
|
|
|
|
|
if(DEBUG_ENABLED)
|
|
|
|
|
{
|
|
|
|
|
volatile uint32_t tick = DL_SYSTICK_getValue();
|
|
|
|
|
//printf("systick is %x \n",tick);
|
|
|
|
|
}
|
|
|
|
|
//开环
|
|
|
|
|
//velocityopenloop(Target);
|
|
|
|
|
//闭环
|
|
|
|
|
Set_Angle(Target);
|
2025-11-13 15:16:24 +08:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2025-11-10 18:05:11 +08:00
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|