4 changed files with 270 additions and 223 deletions
@ -1 +1 @@ |
|||||
Subproject commit ef7a7f2a43038c8655ccfac5d80bab8984a3963a |
|
||||
|
Subproject commit 4257580790dc2dda82d0b03a1323746f321331b3 |
||||
@ -0,0 +1,244 @@ |
|||||
|
#include <stddef.h>
|
||||
|
#include <stdio.h>
|
||||
|
|
||||
|
#include "main.hpp"
|
||||
|
|
||||
|
//
|
||||
|
#include "feite_servo_motor.hpp"
|
||||
|
#include "sdk/os/zos.hpp"
|
||||
|
//
|
||||
|
// #include "sdk\components\cmdscheduler\cmd_scheduler.hpp"
|
||||
|
#include "sdk\components\eq_20_asb_motor\eq20_servomotor.hpp"
|
||||
|
#include "sdk\components\iflytop_can_slave_module_master_end\stepmotor.hpp"
|
||||
|
#include "sdk\components\iflytop_can_slave_v1\iflytop_can_master.hpp"
|
||||
|
#include "sdk\components\step_motor_45\step_motor_45.hpp"
|
||||
|
#include "sdk\components\step_motor_45\step_motor_45_scheduler.hpp"
|
||||
|
#include "sdk\components\zcancmder\zcanreceiver_master.hpp"
|
||||
|
//
|
||||
|
#include "sdk\components/step_motor_ctrl_module/step_motor_ctrl_script_cmder_module.hpp"
|
||||
|
#include "sdk\components/xy_robot_ctrl_module/xy_robot_script_cmder_module.hpp"
|
||||
|
#include "sdk\components\cmdscheduler\cmd_scheduler_v2.hpp"
|
||||
|
#include "sdk\components\eq_20_asb_motor\script_cmder_eq20_servomotor.hpp"
|
||||
|
#include "sdk\components\mini_servo_motor\mini_servo_motor_ctrl_module.hpp"
|
||||
|
#include "sdk\components\mini_servo_motor\scirpt_cmder_mini_servo_motor_ctrl_module.hpp"
|
||||
|
#include "sdk\components\step_motor_45\script_cmder_step_motor_45.hpp"
|
||||
|
// #include "sdk\components\scriptcmder_module\xy_robot_script_cmder_module.hpp"
|
||||
|
// #include "sdk\components\zcancmder_master_module/zcan_master_step_motor_ctrl_module.hpp"
|
||||
|
// #include "sdk\components\zcancmder_master_module\zcan_xy_robot_master_module.hpp"
|
||||
|
|
||||
|
#include "intelligent_winding_robot_ctrl.hpp"
|
||||
|
#include "sdk\components\taojingchi_screen\taojingchi_screen_service.hpp"
|
||||
|
#include "sdk\components\zprotocol_helper\micro_computer_module_device_script_cmder_paser.hpp"
|
||||
|
#include "sdk\components\zprotocols\zcancmder_v2\protocol_proxy.hpp"
|
||||
|
#include "sdk\components\zprotocols\zcancmder_v2\zmodule_device_manager.hpp"
|
||||
|
#include "sdk\components\zprotocols\zcancmder_v2\zmodule_device_script_cmder_paser.hpp"
|
||||
|
namespace iflytop { |
||||
|
extern Main gmain; |
||||
|
}; |
||||
|
|
||||
|
using namespace iflytop; |
||||
|
using namespace std; |
||||
|
|
||||
|
extern "C" {} |
||||
|
/*******************************************************************************
|
||||
|
* 配置 * |
||||
|
*******************************************************************************/ |
||||
|
#if 0
|
||||
|
static StepMotor45::cfg_t cfg4 = { |
||||
|
.max_pos = -1, |
||||
|
.enable_zero_limit = false, |
||||
|
.enable_max_pos_limit = false, |
||||
|
.mirror = true, |
||||
|
|
||||
|
.zeroPin = PinNull, |
||||
|
.zeroPinMirror = false, |
||||
|
|
||||
|
.driverPin = {PE0, PE2, PE4, PE6}, |
||||
|
.driverPinMirror = true, |
||||
|
}; |
||||
|
|
||||
|
static StepMotor45::cfg_t cfg5 = { |
||||
|
.max_pos = -1, |
||||
|
.enable_zero_limit = false, |
||||
|
.enable_max_pos_limit = false, |
||||
|
.mirror = true, |
||||
|
|
||||
|
.zeroPin = PinNull, |
||||
|
.zeroPinMirror = false, |
||||
|
|
||||
|
.driverPin = {PC13, PE5, PE3, PE1}, |
||||
|
.driverPinMirror = true, |
||||
|
}; |
||||
|
static StepMotor45::cfg_t cfg6 = { |
||||
|
.max_pos = -1, |
||||
|
.enable_zero_limit = false, |
||||
|
.enable_max_pos_limit = false, |
||||
|
.mirror = true, |
||||
|
|
||||
|
.zeroPin = PinNull, |
||||
|
.zeroPinMirror = false, |
||||
|
|
||||
|
.driverPin = {PC12, PD3, PD5, PD7}, |
||||
|
.driverPinMirror = true, |
||||
|
}; |
||||
|
#endif
|
||||
|
|
||||
|
namespace iflytop { |
||||
|
/*******************************************************************************
|
||||
|
* 基础组件 * |
||||
|
*******************************************************************************/ |
||||
|
extern ZCanCommnaderMaster m_zcanCommnaderMaster; // can总线
|
||||
|
extern ModbusBlockHost g_modbusblockhost; // modbus总线
|
||||
|
extern FeiTeServoMotor g_feiteservomotor_bus; // 飞特舵机总线
|
||||
|
extern ZModuleDeviceManager g_zmodule_device_manager; // 用于管理所有的设备
|
||||
|
extern StepMotor45Scheduler step_motor45_scheduler; // 45步进电机调度器
|
||||
|
|
||||
|
extern CmdSchedulerV2 g_cmdScheduler; // 串口字符串指令总线
|
||||
|
extern TaoJingChiScreenService g_taojingchi_screen_service; // 淘精驰屏幕服务
|
||||
|
extern MicroComputerModuleDeviceScriptCmderPaser g_zmodule_device_script_cmder_paser; // 用于解析所有的设备指令
|
||||
|
|
||||
|
/*******************************************************************************
|
||||
|
* 本地设备 * |
||||
|
*******************************************************************************/ |
||||
|
extern Eq20ServoMotor g_main_servo_motor; |
||||
|
extern StepMotor45 g_step_motor45[7]; |
||||
|
extern MiniRobotCtrlModule g_mini_servo[6]; |
||||
|
/*******************************************************************************
|
||||
|
* CAN设备 * |
||||
|
*******************************************************************************/ |
||||
|
extern ZIProtocolProxy g_xyrobotctrlmodule; |
||||
|
extern ZIProtocolProxy g_z_step_motor; |
||||
|
|
||||
|
extern IntelligentWindingRobotCtrl g_intelligent_winding_robot_ctrl; |
||||
|
|
||||
|
} // namespace iflytop
|
||||
|
|
||||
|
extern "C" { |
||||
|
extern DMA_HandleTypeDef hdma_usart3_rx; |
||||
|
extern DMA_HandleTypeDef hdma_usart3_tx; |
||||
|
} |
||||
|
|
||||
|
extern "C" {} |
||||
|
extern DMA_HandleTypeDef hdma_usart2_rx; |
||||
|
extern DMA_HandleTypeDef hdma_usart2_tx; |
||||
|
|
||||
|
void script_reg_fn() { |
||||
|
#if 0
|
||||
|
xy_robot_ctrl_enable (id,en) |
||||
|
xy_robot_ctrl_factory_reset (id) |
||||
|
xy_robot_ctrl_flush (id) |
||||
|
xy_robot_ctrl_force_change_current_pos (id,x,y) |
||||
|
xy_robot_ctrl_get_base_param (id) |
||||
|
xy_robot_ctrl_move_by (id,dx,dy,v) |
||||
|
|
||||
|
|
||||
|
xy_robot_ctrl_move_to (id,x,y,speed) |
||||
|
xy_robot_ctrl_move_to_zero (id) |
||||
|
xy_robot_ctrl_move_to_zero_with_calibrate (id,nowx,nowy) |
||||
|
xy_robot_ctrl_stop (id,stop_type) |
||||
|
#endif
|
||||
|
#define XY_ROBOT_ID 3
|
||||
|
|
||||
|
g_cmdScheduler.regCMD("xy_robot_ctrl_enable", "(id,en)", 2, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t en = atoi(paraV[1]); |
||||
|
int32_t ecode = g_zmodule_device_manager.xymotor_enable(XY_ROBOT_ID, en); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("xy_robot_ctrl_factory_reset", "(id)", 1, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t ecode = g_zmodule_device_manager.module_factory_reset(XY_ROBOT_ID); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("xy_robot_ctrl_flush", "(id)", 1, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t ecode = g_zmodule_device_manager.module_flush_cfg(XY_ROBOT_ID); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
#if 0
|
||||
|
g_cmdScheduler.regCMD("xy_robot_ctrl_force_change_current_pos", "(id,x,y)", 3, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t x = atoi(paraV[1]); |
||||
|
int32_t y = atoi(paraV[2]); |
||||
|
int32_t ecode = g_zmodule_device_manager.motor_set_current_pos_by_change_shift(XY_ROBOT_ID, x, y); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
#endif
|
||||
|
|
||||
|
g_cmdScheduler.regCMD("xy_robot_ctrl_get_base_param", "(id)", 1, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { g_zmodule_device_script_cmder_paser.do_dumpconfig(paramN, paraV, ack); }); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("xy_robot_ctrl_move_by", "(id,dx,dy,v)", 4, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t dx = atoi(paraV[1]); |
||||
|
int32_t dy = atoi(paraV[2]); |
||||
|
int32_t v = atoi(paraV[3]); |
||||
|
int32_t ecode = g_zmodule_device_manager.xymotor_move_by(XY_ROBOT_ID, dx, dy, v); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("xy_robot_ctrl_move_to", "(id,x,y,speed)", 4, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t x = atoi(paraV[1]); |
||||
|
int32_t y = atoi(paraV[2]); |
||||
|
int32_t speed = atoi(paraV[3]); |
||||
|
int32_t ecode = g_zmodule_device_manager.xymotor_move_to(XY_ROBOT_ID, x, y, speed); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("xy_robot_ctrl_move_to_zero", "(id)", 1, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t ecode = g_zmodule_device_manager.xymotor_move_to_zero(XY_ROBOT_ID); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("xy_robot_ctrl_move_to_zero_with_calibrate", "(id,nowx,nowy)", 3, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t nowx = atoi(paraV[1]); |
||||
|
int32_t nowy = atoi(paraV[2]); |
||||
|
int32_t ecode = g_zmodule_device_manager.xymotor_move_to_zero_and_calculated_shift(XY_ROBOT_ID); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("xy_robot_ctrl_stop", "(id,stop_type)", 2, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t stop_type = atoi(paraV[1]); |
||||
|
int32_t ecode = g_zmodule_device_manager.module_stop(XY_ROBOT_ID); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
#if 0
|
||||
|
00102227 INFO [CMD ] step_motor_ctrl_enable (id,en) |
||||
|
00102251 INFO [CMD ] step_motor_ctrl_get_base_param (id) |
||||
|
00102277 INFO [CMD ] step_motor_ctrl_move_by (id,dx,speed) |
||||
|
00102283 INFO [CMD ] step_motor_ctrl_move_to (id,x,speed) |
||||
|
00102298 INFO [CMD ] step_motor_ctrl_move_to_zero (id) |
||||
|
00102304 INFO [CMD ] step_motor_ctrl_move_to_zero_with_calibrate (id,x) |
||||
|
00102311 INFO [CMD ] step_motor_ctrl_read_detailed_status (id) |
||||
|
00102318 INFO [CMD ] step_motor_ctrl_read_status (id) |
||||
|
00102330 INFO [CMD ] step_motor_ctrl_rotate (id,speed,lastforms) |
||||
|
00102362 INFO [CMD ] step_motor_ctrl_stop (id,stop_type) |
||||
|
#endif
|
||||
|
|
||||
|
g_cmdScheduler.regCMD("step_motor_ctrl_enable", "(id,en)", 2, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t en = atoi(paraV[1]); |
||||
|
int32_t ecode = g_zmodule_device_manager.motor_enable(4, en); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("step_motor_ctrl_get_base_param", "(id)", 1, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { //
|
||||
|
g_zmodule_device_script_cmder_paser.do_dumpconfig(4); |
||||
|
}); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("step_motor_ctrl_move_by", "(id,dx,speed)", 3, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t dx = atoi(paraV[1]); |
||||
|
int32_t speed = atoi(paraV[2]); |
||||
|
int32_t ecode = g_zmodule_device_manager.motor_move_by(4, dx, speed, 0); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("step_motor_ctrl_move_to", "(id,x,speed)", 3, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t x = atoi(paraV[1]); |
||||
|
int32_t speed = atoi(paraV[2]); |
||||
|
int32_t ecode = g_zmodule_device_manager.motor_move_to(4, x, speed, 0); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
|
||||
|
g_cmdScheduler.regCMD("step_motor_ctrl_move_to_zero", "(id)", 1, [](int32_t paramN, const char** paraV, ICmdParserACK* ack) { |
||||
|
int32_t ecode = g_zmodule_device_manager.motor_move_to_zero_backward(4, 0, 0, 0, 0); |
||||
|
ack->setNoneAck(ecode); |
||||
|
}); |
||||
|
|
||||
|
|
||||
|
} |
||||
Write
Preview
Loading…
Cancel
Save
Reference in new issue