|
|
@ -7,7 +7,8 @@ |
|
|
|
#include "project.hpp"
|
|
|
|
//
|
|
|
|
#include "one_dimensional_code_laser_scanner.hpp"
|
|
|
|
#include "sdk/components/single_axis_motor_control_v2/single_axis_motor_control_v2.hpp"
|
|
|
|
// #include "sdk/components/single_axis_motor_control_v2/single_axis_motor_control_v2.hpp"
|
|
|
|
#include "sdk/components/single_axis_motor_control/single_axis_motor_control.hpp"
|
|
|
|
#include "sdk/hal/zhal.hpp"
|
|
|
|
#include "sdk\components\iflytop_can_slave_v1\iflytop_can_slave.hpp"
|
|
|
|
#include "sdk\components\tmc\ic\ztmc4361A.hpp"
|
|
|
@ -45,8 +46,8 @@ ZGPIO io_fybjl_sensor1; |
|
|
|
ZGPIO io_fybjl_sensor0; |
|
|
|
|
|
|
|
DeviceBaseControlService m_deviceBaseControlService; |
|
|
|
SingleAxisMotorControlerV2 m_pyMotorControlService; // 平移电机
|
|
|
|
SingleAxisMotorControlerV2 m_tjMotorControlService; // 推进电机
|
|
|
|
SingleAxisMotorControler m_pyMotorControlService; // 平移电机
|
|
|
|
SingleAxisMotorControler m_tjMotorControlService; // 推进电机
|
|
|
|
OneDimensionalCodeLaserScanner m_oneDimensionalCodeLaserScanner; |
|
|
|
|
|
|
|
void input_sensors_init() { |
|
|
@ -161,15 +162,15 @@ void Main::run() { |
|
|
|
auto *cfg = IflytopCanProtocolStackProcesser::createDefaultConfig(DEVICE_ID, 128); |
|
|
|
m_protocolStack.initialize(cfg); |
|
|
|
m_protocolStack.setDumpPacketFlag(false); |
|
|
|
m_protocolStack.registerListener(this); |
|
|
|
m_protocolStack.activeReg(REG_GPIO_INPUT0, icps::kwr, 0); |
|
|
|
// m_protocolStack.registerListener(this);
|
|
|
|
// m_protocolStack.activeReg(REG_GPIO_INPUT0, icps::kwr, 0);
|
|
|
|
} |
|
|
|
|
|
|
|
{ //
|
|
|
|
m_deviceBaseControlService.initialize(&m_protocolStack, DEVICE_ID); |
|
|
|
m_deviceBaseControlService.setListener([](int32_t engineer_mode) { |
|
|
|
m_pyMotorControlService.setEngineerMode(engineer_mode); |
|
|
|
m_tjMotorControlService.setEngineerMode(engineer_mode); |
|
|
|
// m_pyMotorControlService.setEngineerMode(engineer_mode);
|
|
|
|
// m_tjMotorControlService.setEngineerMode(engineer_mode);
|
|
|
|
}); |
|
|
|
} |
|
|
|
|
|
|
|