WRS2020用にメカナム台車をROS化

Dependencies:   mbed PID2 JY901 QuaternionMath ros_lib_melodic i2cmaster WRS2020_mecanum_node

Dependents:   WRS2020_mecanum_node

define.h

Committer:
sgrsn
Date:
2021-02-23
Revision:
5:17ede03f1fa5
Parent:
0:c177452db984

File content as of revision 5:17ede03f1fa5:

#ifndef MY_DEFINE_H
#define MY_DEFINE_H

#define PI 3.141592654

float DEG_TO_RAD = PI/180.0;
float RAD_TO_DEG = 180.0/PI;

float wheel_d = 0.127;           // メカナム直径[mm]
float wheel_r = 0.0635;
float deg_per_pulse = 0.0072;   // ステッピングモータ(AR46SAK-PS50-1)

// 目標位置到達判定
float threshold_x     = 5; //[mm]
float threshold_y     = 5; //[mm]
float threshold_theta = 1 * DEG_TO_RAD;

/*Common for Master and Slave***************/

typedef enum
{
    RightForward    = 1,
    LeftForward     = 2,
    RightBack       = 3,
    LeftBack        = 4
}MotorPosition;

typedef enum
{
    COAST   = 0,
    BRAKE   = 1,    
    CW      = 2,
    CCW     = 3
}MotorState;

#define WHO_AM_I        0x00
#define MY_IIC_ADDR     0x01
#define MOTOR_DIR       0x04
#define PWM_FREQUENCY   0x05


/*Master only**************************************/

#define MOTOR_NUM 4
#define IIC_ADDR1        0xB0
#define IIC_ADDR2        0xC0
#define IIC_ADDR3        0xD0
#define IIC_ADDR4        0xE0

#define MaxFrequency   70000
#define MinFrequency   0//50

// Register Map from PC
#define MARKER_X        0x05
#define MARKER_Y        0x06
#define MARKER_Z        0x07
#define MARKER_ROLL     0x08
#define MARKER_PITCH    0x09
#define MARKER_YAW      0x010

#endif