10 changed files with 94 additions and 115 deletions
-
36.cproject
-
3.gitmodules
-
1a8000_protocol
-
2sdk
-
17usrc/gservice.cpp
-
23usrc/gservice.hpp
-
18usrc/main.cpp
-
105usrc/main.cpp.bak
-
2usrc/subboards/subboard30_shake_module/subboard30_shake_module.cpp
-
2usrc/subboards/subboard30_shake_module/subboard30_shake_module.hpp
@ -1 +1 @@ |
|||
Subproject commit fd424aeed7fd56ee83369b2e1a92ef7f913914f0 |
|||
Subproject commit 4fbd2bdf3a29557a93e7d1ae8d9ce6d14c5b970b |
|||
@ -0,0 +1,17 @@ |
|||
#include "gservice.hpp"
|
|||
|
|||
#include "configs/device_id_mgr.hpp"
|
|||
|
|||
using namespace iflytop; |
|||
|
|||
void GService::initialize() { //
|
|||
|
|||
ZCanReceiver::CFG* zcanreceiver_cfg = zcanreceiver.createCFG(zdevice_id_mgr_get_device_id()); |
|||
zcanreceiver.initialize(zcanreceiver_cfg); |
|||
zcan_protocol_parser.initialize(&zcanreceiver); |
|||
} |
|||
|
|||
GService* GService::inst() { |
|||
static GService gservice; |
|||
return &gservice; |
|||
} |
|||
@ -0,0 +1,23 @@ |
|||
#include <stddef.h>
|
|||
#include <stdio.h>
|
|||
|
|||
#include "a8000_protocol\zcan_protocol_parser.hpp"
|
|||
#include "sdk/chip/chip.hpp"
|
|||
#include "sdk/components/zcancmder/zcanreceiver.hpp"
|
|||
#include "sdk/os/zos.hpp"
|
|||
|
|||
namespace iflytop { |
|||
|
|||
class GService { |
|||
ZCanReceiver zcanreceiver; |
|||
ZCanProtocolParser zcan_protocol_parser; |
|||
|
|||
public: |
|||
void initialize(); |
|||
|
|||
static GService* inst(); |
|||
|
|||
ZCanReceiver* getZCanReceiver() { return &zcanreceiver; } |
|||
}; |
|||
|
|||
} // namespace iflytop
|
|||
@ -1,105 +0,0 @@ |
|||
#include <stddef.h> |
|||
#include <stdio.h> |
|||
|
|||
#include "board.h" |
|||
#include "sdk\components\subcanmodule\zcancmder_subboard_initer.hpp" |
|||
/******************************************************************************* |
|||
* PROJECT_INCLUDE * |
|||
*******************************************************************************/ |
|||
#include "sdk/components/step_motor_ctrl_module/step_motor_ctrl_module.hpp" |
|||
#include "sdk\components\mini_servo_motor\feite_servo_motor.hpp" |
|||
#include "sdk\components\mini_servo_motor\mini_servo_motor_ctrl_module.hpp" |
|||
#include "sdk\components\sensors\m3078\m3078_code_scaner.hpp" |
|||
#include "sdk\components\tmc\ic\ztmc5130.hpp" |
|||
|
|||
#define TAG "main" |
|||
using namespace iflytop; |
|||
using namespace std; |
|||
|
|||
static ZCancmderSubboardIniter initer; |
|||
|
|||
extern void umain(); |
|||
extern "C" { |
|||
void StartDefaultTask(void const* argument) { umain(); } |
|||
} |
|||
/******************************************************************************* |
|||
* GET_DEVICE_ID * |
|||
*******************************************************************************/ |
|||
static int32_t getDeviceId() { return BOARD_ID; } |
|||
/******************************************************************************* |
|||
* INIT_SUBMODULE * |
|||
*******************************************************************************/ |
|||
void nvs_init_cb() {} |
|||
static void initsubmodule() { |
|||
#if 0 |
|||
#define INLET_SPEED 300 |
|||
#define OUTET_SPEED 300 |
|||
#define TANSLATE_SPEED 500 |
|||
/** |
|||
* @brief ÈëÁÏ |
|||
*/ |
|||
{ |
|||
static TMC5130 motor; |
|||
static StepMotorCtrlModule stepMotorCtrlModule; |
|||
|
|||
TMC5130::cfg_t cfg = { |
|||
.spi = &TMC_MOTOR_SPI, // |
|||
.csgpio = MOTOR1_CSN, // |
|||
.ennPin = MOTOR1_ENN, // |
|||
.spi_mode_select = MOTOR1_SPI_MODE_SELECT, // |
|||
}; |
|||
motor.initialize(&cfg); |
|||
motor.setMotorShaft(false); |
|||
ZLOGI(TAG, "motor1 initialize 5160:%x ", motor.readICVersion()); |
|||
|
|||
static ZGPIO input[2]; |
|||
input[0].initAsInput(MOTOR1_REFL /*REFL*/, ZGPIO::kMode_nopull, ZGPIO::kIRQ_noIrq, true); |
|||
input[1].initAsInput(MOTOR1_REFR /*REFR*/, ZGPIO::kMode_nopull, ZGPIO::kIRQ_noIrq, true); |
|||
|
|||
StepMotorCtrlModule::flash_config_t smcm_cfg = {0}; |
|||
StepMotorCtrlModule::create_default_cfg(smcm_cfg); |
|||
|
|||
smcm_cfg.base_param.motor_shift = 0; |
|||
smcm_cfg.base_param.motor_shaft = 0; |
|||
smcm_cfg.base_param.motor_one_circle_pulse = 100; |
|||
smcm_cfg.base_param.motor_one_circle_pulse_denominator = 1; |
|||
smcm_cfg.base_param.motor_default_velocity = INLET_SPEED; |
|||
smcm_cfg.base_param.motor_default_acc = 300; |
|||
smcm_cfg.base_param.motor_default_dec = 300; |
|||
smcm_cfg.base_param.motor_run_to_zero_max_d = 5000; |
|||
smcm_cfg.base_param.motor_look_zero_edge_max_d = 100; |
|||
smcm_cfg.base_param.motor_run_to_zero_speed = 50; |
|||
smcm_cfg.base_param.motor_run_to_zero_dec = 600; |
|||
smcm_cfg.base_param.motor_look_zero_edge_speed = 100; |
|||
smcm_cfg.base_param.motor_look_zero_edge_dec = 900; |
|||
smcm_cfg.base_param.stepmotor_ihold = 1; |
|||
smcm_cfg.base_param.stepmotor_irun = 24; |
|||
smcm_cfg.base_param.stepmotor_iholddelay = 1000; |
|||
|
|||
stepMotorCtrlModule.initialize(initer.get_module_id(1), &motor, input, ZARRAY_SIZE(input), nullptr, &smcm_cfg); |
|||
initer.register_module(&stepMotorCtrlModule); |
|||
} |
|||
#endif |
|||
} |
|||
|
|||
/******************************************************************************* |
|||
* MAIN * |
|||
*******************************************************************************/ |
|||
void umain() { |
|||
ZCancmderSubboardIniter::cfg_t cfg = // |
|||
{ |
|||
.deviceId = getDeviceId(), |
|||
.input_gpio = |
|||
{ |
|||
{.pin = PD0, .mode = ZGPIO::kMode_nopull, .irqtype = ZGPIO::kIRQ_noIrq, .mirror = true}, |
|||
{.pin = PD1, .mode = ZGPIO::kMode_nopull, .irqtype = ZGPIO::kIRQ_noIrq, .mirror = true}, |
|||
{.pin = PD2, .mode = ZGPIO::kMode_nopull, .irqtype = ZGPIO::kIRQ_noIrq, .mirror = true}, |
|||
{.pin = PD3, .mode = ZGPIO::kMode_nopull, .irqtype = ZGPIO::kIRQ_noIrq, .mirror = true}, |
|||
{.pin = PD4, .mode = ZGPIO::kMode_nopull, .irqtype = ZGPIO::kIRQ_noIrq, .mirror = true}, |
|||
}, |
|||
.output_gpio = {}, |
|||
}; |
|||
initer.init(&cfg); |
|||
initsubmodule(); |
|||
initer.loop(); |
|||
} |
|||
Write
Preview
Loading…
Cancel
Save
Reference in new issue