74 lines
2.3 KiB
C
74 lines
2.3 KiB
C
/*
|
|
* 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"
|
|
#include "Delay.h"
|
|
#include "MT6701.h"
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <pwm.h>
|
|
|
|
extern float angle_f;
|
|
|
|
const float num_f = 0.123456f;
|
|
|
|
volatile uint16_t count = 0 ;
|
|
|
|
|
|
int pp = 7; //电机极对数
|
|
int Dir = 1; //电机编码器方向
|
|
|
|
int main(void)
|
|
{
|
|
SYSCFG_DL_init();
|
|
NVIC_EnableIRQ(UART_0_INST_INT_IRQN);
|
|
DL_TimerA_startCounter(PWM_0_INST);
|
|
while (1) {
|
|
DL_GPIO_togglePins(LED_PORT,LED_PA0_PIN);
|
|
//MT6701_get_angle_degree();
|
|
delay_ms(50);
|
|
volatile float angle_rad = GetAngle();
|
|
//printf("test \n");
|
|
printf("angle %.5f \n" , angle_rad);
|
|
volatile uint32_t tick = DL_SYSTICK_getValue();
|
|
printf("systick is %x \n",tick);
|
|
|
|
PWM_Channel1(count ++);
|
|
if(count == 750)
|
|
count = 0;
|
|
|
|
}
|
|
}
|
|
|
|
|