控制步进电机驱动器同时控制四路舵机机械臂
接上篇: 【感芯科技MC3172开发板体验】+游戏机器人创意设计(1)开源(芯片简介) - RISC-V MCU威廉希尔官方网站
社区 - 电子威廉希尔官方网站
论坛 - 广受欢迎的专业电子论坛! https://bbs.elecfans.com/jishu_2360536_1_1.html
本篇主要是试验品搭建,实验项目的可行性,如上方视频。
源代码:
INTDEV_SET_CLK_RST(GPIOD_BASE_ADDR,(INTDEV_RUN|INTDEV_IS_GROUP0|INTDEV_CLK_IS_CORECLK_DIV2));
GPIO_SET_OUTPUT_EN_VALUE(GPIOD_BASE_ADDR,(GPIO_PIN12|GPIO_PIN10|GPIO_PIN6|GPIO_PIN15|GPIO_PIN2),GPIO_SET_ENABLE);
GPIO_SET_OUTPUT_PIN_TO_1(GPIOD_BASE_ADDR,(GPIO_PIN12|GPIO_PIN10|GPIO_PIN6|GPIO_PIN15|GPIO_PIN2));
while(1){ GPIO_SET_OUTPUT_PIN_INV(GPIOD_BASE_ADDR,GPIO_PIN15);
for (u32 v = 80; v > 40 ; v-- )
{
GPIO_SET_OUTPUT_PIN_TO_1(GPIOD_BASE_ADDR,(GPIO_PIN12|GPIO_PIN10|GPIO_PIN6|GPIO_PIN2));
for(u32 var = 0; var < 4000; ++var)
{
NOP();
}
GPIO_SET_OUTPUT_PIN_TO_0(GPIOD_BASE_ADDR,(GPIO_PIN12|GPIO_PIN10|GPIO_PIN6|GPIO_PIN2));
for(u32 var = 0; var < 36000; ++var)
{
NOP();
}
}
for (u32 v = 80; v > 40 ; v-- )
{
GPIO_SET_OUTPUT_PIN_TO_1(GPIOD_BASE_ADDR,(GPIO_PIN12|GPIO_PIN10|GPIO_PIN6|GPIO_PIN2));
for(u32 var = 0; var < 2000; ++var)
{
NOP();
}
GPIO_SET_OUTPUT_PIN_TO_0(GPIOD_BASE_ADDR,(GPIO_PIN12|GPIO_PIN10|GPIO_PIN6|GPIO_PIN2));
for(u32 var = 0; var < 38000; ++var)
{
NOP();
}
}
}
感芯科技64线程2
|