https://os.mbed.com/users/sayzyas
Dependencies: QEI TextLCD mbed
common.h
- Committer:
- sayzyas
- Date:
- 2018-07-26
- Revision:
- 0:73dd48be5ca6
File content as of revision 0:73dd48be5ca6:
/* Information */ #define LatestUpDate "2017.08.30" #define ProgramRevision "Rev 2.30" #define Author "Y.Saito(zinsor)" #define Company "Revast Co.,Ltd" /* ****************************************** */ /* Motor */ /* ****************************************** */ enum{ MOTOR_RFCRW, // RF crawler MOTOR_LBCRW, // LB crawler MOTOR_RFTFM, // RF Transform MOTOR_LBTFM, // LB transform MOTOR_WINCH, // Winch MOTOR_CMPAN, // Pan MOTOR_CTILT, // Tilt MOTOR_CABLE // Cable transfar }; enum{ MOTOR_DIR_FWD, // Motor forwaed rotation MOTOR_DIR_RVS, // Motor reverse rotation MOTOR_DIR_STP // Motor stop }; enum{ MOTOR_NO0, MOTOR_NO1, MOTOR_NO2, MOTOR_NO3 }; /* ****************************************** */ /* I2C */ /* ****************************************** */ #define NumberOfI2CCommand 12 enum{ I2C_CP_COMMAND, // instruction command I2C_CP_MOTORNO, // motor number I2C_CP_M_DIR, // motor rotation direction I2C_CP_M_CNTTH_U, // motor current limit detection threshold upper byte I2C_CP_M_CNTTH_L, // motor current limit detection threshold lower byte I2C_CP_WDRAM_DIA_X100_UPPER, // winch dram motor diameter upper I2C_CP_WDRAM_DIA_X100_LOWER, // winch dram motor diameter lower I2C_CP_ADJUST_VALUE_X10000_UPPER, // cable diameter upper byte I2C_CP_ADJUST_VALUE_X10000_LOWER, // cable diameter lower byte I2C_CP_RESOLVER_RESO, // resolver resolution (bit) I2C_CP_PRESET_CPOS_UPPER, // preset position upper I2C_CP_PRESET_CPOS_LOWER // preset position lower }; #define I2C_ADDRESS_RESOLVER 0x02 /* ****************************************** */ /* Parameters */ /* ****************************************** */ #define MAX_DROP_AMOUNT 3495 /* Maxmun dropping distance : ex 3500 (mm) */ #define DROP_AMOUNT_ADJ 10 /* Maxmun dropping distance : ex 3500 (mm) */ #define CALIBRATION_COUNT 300 /* Joystick calibration count */ #define DEAD_BAND 5 /* Joystick dead band wide */ #define ROTATE_PER_RESOLUTION 24 /* For QEI */ #define PAI 3.14159265359 #define LED_ON 0 #define LED_OFF 1 /* ****************************************** */ /* Structure */ /* ****************************************** */ /* Winch setting value */ typedef struct { uint16_t cth_dram_mtr_f; // 2 Current threshold: winch dram Motor ( forward ) uint16_t cth_dram_mtr_r; // 2 Current threshold: winch dram Motor ( reverse ) uint16_t cth_cabl_mtr_f; // 2 Current threshold: winch cable Motor ( forward ) uint16_t cth_cabl_mtr_r; // 2 Current threshold: winch cable Motor ( reverse ) uint16_t dram_dmtr_x100; // 2 Winch dram diameter x 100 uint16_t adj_val_x10000; // 2 Winch adjust value x 100 uint8_t res_resolution; // 2 Winch resolver resolution (bit) uint8_t reserved_1; // 1 reserved for future use uint8_t reserved_2; // 1 reserved for future use uint8_t reserved_3; // 1 reserved for future use } wch_SetValue_t; typedef struct SetValue { wch_SetValue_t wchCtrl; } setValue_t;