Ангел, погодь ты
1) Аскар, почему в функцию СетКомпаре передаешь мс? Разве второй параметр - это время?
2) сколько временных отрезков 1000 мс в двадцати миллисекундах?
Технический форум по робототехнике.
#include <stdio.h>
#include <stm32f4xx.h>
#include <stm32f4xx_gpio.h>
#include <stm32f4xx_rcc.h>
#include <stm32f4xx_tim.h>
#include <stm32f4xx_exti.h>
#include <misc.h>
#include <stm32f4xx_syscfg.h>
TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
TIM_OCInitTypeDef TIM_OCInitStructure;
__IO uint16_t Servo1Pulse = 1000; // 1000 us = 1 ms
__IO uint16_t Servo2Pulse = 2000; // 2000 us = 2 ms
void TIM4_IRQHandler(void)
{
uint16_t capture = 0;
// обрабочик прерывания первого канала
if (TIM_GetITStatus(TIM4, TIM_IT_CC1) != RESET)
{
TIM_ClearITPendingBit(TIM4, TIM_IT_CC1 );
//capture = TIM_GetCapture1(TIM4);
TIM_SetCompare1(TIM4, capture + Servo1Pulse );
}
}
int main(void)
{
SystemInit();
/* Инициализация таймера */
GPIO_InitTypeDef GPIO_InitStructure;
NVIC_InitTypeDef NVIC_InitStructure;
// Инициализация портов вводов/вывода
/* Тактируем порты D */
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD, ENABLE);
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12; // Ножка PD12
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz;
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
GPIO_Init(GPIOD, &GPIO_InitStructure);
// Цепляем выход PD12
GPIO_PinAFConfig(GPIOD, GPIO_PinSource12, GPIO_AF_TIM4);
// Инициализация прерывания
NVIC_InitStructure.NVIC_IRQChannel = TIM4_IRQn;
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0;
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
NVIC_Init(&NVIC_InitStructure);
// Инициализируем таймер 4
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);
TIM_TimeBaseStructure.TIM_Prescaler = 56;//(uint16_t) ( ( (SystemCoreClock / 2) / 1000000) - 1);
TIM_TimeBaseStructure.TIM_Period = 60000; // 20000; // 20 ms
TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
TIM_TimeBaseStructure.TIM_ClockDivision = 0;
TIM_TimeBaseStructure.TIM_RepetitionCounter = 0;
TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure);
// Инициализируем ШИМ
TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;
TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
TIM_OCInitStructure.TIM_Pulse = Servo1Pulse;
TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;
TIM_OC1Init(TIM4, &TIM_OCInitStructure);
/* Включаем таймер */
TIM_Cmd(TIM4, ENABLE);
/* Цепляем обрабодчик прерывания */
TIM_ITConfig(TIM4, TIM_IT_CC1, ENABLE);
while (1)
{
}
}
Askar писал(а):У меня выходит 200-700 (180)
Angel71 писал(а):аха, ко всем родимым индивидуально. только как вы таким кодом сразу двадцатью собираетесь управлять?
#include <stdio.h>
#include <stm32f4xx.h>
#include <stm32f4xx_gpio.h>
#include <stm32f4xx_rcc.h>
#include <stm32f4xx_tim.h>
#include <stm32f4xx_exti.h>
#include <misc.h>
#include <stm32f4xx_syscfg.h>
__IO uint16_t SERVO_0 = 200; // 1000 us = 1 ms
__IO uint16_t SERVO_180 = 950; // 2000 us = 2 ms
//#define SERVO_180 1200
//#define SERVO_0 200
// Функция устанавливает позицию вала (в градусах)
void set_pos(uint8_t pos)
{
uint32_t tmp=(SERVO_180 - SERVO_0) / 180 ;
uint16_t ServoPulse = SERVO_0 + tmp * pos;
TIM_SetCompare1(TIM4, ServoPulse );
//TIM2->CCR2 = SERVO_0 + tmp * pos;
}
// Функция задержки
void delay(void)
{
volatile uint32_t i;
for (i=1; i != 0xFFFF; i++)
;
}
int main(void)
{
SystemInit();
// Инициализация портов вводов/вывода
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD, ENABLE);
GPIO_InitTypeDef GPIO_InitStructure;
GPIO_StructInit(&GPIO_InitStructure);
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12; // Ножка PD12
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;
GPIO_Init(GPIOD, &GPIO_InitStructure);
//------------------------------------------------------------------------------------------
// Инициализируем таймер 4
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);
uint16_t Prescaler = ( (SystemCoreClock / 2) / 1000000) - 1; // 1hz
uint16_t Period = 20000-1; // 20000; // 20 ms
TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
TIM_TimeBaseStructInit (&TIM_TimeBaseStructure);
TIM_TimeBaseStructure.TIM_Prescaler = Prescaler;
TIM_TimeBaseStructure.TIM_Period = Period;
TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure);
// Разрешаем таймеру обращаться к выходу PD12
GPIO_PinAFConfig(GPIOD, GPIO_PinSource12, GPIO_AF_TIM4);
//------------------------------------------------------------------------------------------
// Инициализируем ШИМ
TIM_OCInitTypeDef TIM_OCInitStructure;
TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;
TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
TIM_OCInitStructure.TIM_Pulse = SERVO_0;
TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;
TIM_OC1Init(TIM4, &TIM_OCInitStructure);
TIM_Cmd(TIM4, ENABLE);
delay();
TIM_SetCompare1(TIM4, 460); // 90
delay();
TIM_SetCompare1(TIM4, 760 ); // 180
//Начинаем крутить сервой от 0 до 180 градусов.
/*
uint8_t i;
while(1)
{
for (i=0;i<=180;i++)
{
delay();
set_pos(i);
}
}
*/
while (1) { }
}