45

Dependencies:   mbed BufferedSerial LS7366LIB FastPWM

main.h

Committer:
lsh2205
Date:
2020-03-23
Revision:
0:c21936a3520a

File content as of revision 0:c21936a3520a:

double Speed_Igain[6]={ 0.1,
                        0.1,
                        0.1,
                        0.1,
                        0.1,
                        0.1};
double Speed_Pgain[6]={ 5,
                        5,
                        5,
                        5,
                        5,
                        5};
double Position_input_filter[6]
                     ={ 0.05,
                        0.05,
                        0.05,
                        0.05,
                        0.05,
                        0.05};

double position_Pgain[6]
                     ={ 20,
                        20,
                        20,
                        20,
                        20,
                        20};

double offset[6]={      1480,
                        1480,
                        1480,
                        1480,
                        1480,
                        1480};
                        
double Speed_I_input_filter[6]
                     ={ 0.005,
                        0.005,
                        0.005,
                        0.005,
                        0.005,
                        0.005};


// SPI
#define SPI_MOSI1       PA_7
#define SPI_MISO1       PA_6
#define SPI_SCK1        PA_5

// Encoder
#define ENCODER_CS1     PB_0
#define ENCODER_CS2     PC_1
#define ENCODER_CS3     PC_0
#define ENCODER_CS4     PB_15
#define ENCODER_CS5     PB_14
#define ENCODER_CS6     PB_13

// Limit switch

#define LIMIT_SW1       PC_3
#define LIMIT_SW2       PC_2
#define LIMIT_SW3       PC_5
#define LIMIT_SW4       PC_9
#define LIMIT_SW5       PC_6
#define LIMIT_SW6       PC_8

// Motor
#define MOTOR_PWM1      PA_15
#define MOTOR_PWM2      PA_9
#define MOTOR_PWM3      PA_8
#define MOTOR_PWM4      PB_10
#define MOTOR_PWM5      PB_3
#define MOTOR_PWM6      PA_10

#include "spi_setup.h"
#include "motor.h"
#include "encoder.h"
#include "timer.h"
#include "speed_pid.h"
#include "target_position_cal.h"
#include "Position.h"
#include "pc_serial.h"
#include "limit.h"
//#include "SPI_TO_UART.h"


void board_init()
{
    /*
    set_data[1]=Speed_Igain;
    set_data[2]=Speed_Pgain;
    set_data[4]=Position_input_filter;
    set_data[5]=position_Pgain1;
    set_data[6]=position_Pgain2;
    set_data[7]=position_Pgain3;
    set_data[8]=offset;
    */
    limit_init();
    SPI_INIT();
    motor_init();
    Serial_Init();
    timer_init();
    
}