File content as of revision 18:65707db67191:

#include "mbed.h"
#include "L6208.h"

#define VREFA_PWM_PIN D3
#define VREFB_PWM_PIN D9

l6208_init_t init =
{
  2000,            //Acceleration rate in step/s^2 or (1/16)th step/s^2 for microstep modes
  80,              //Acceleration current torque in % (from 0 to 100)
  2000,            //Deceleration rate in step/s^2 or (1/16)th step/s^2 for microstep modes
  80,              //Deceleration current torque in % (from 0 to 100)
  6000,            //Running speed in step/s or (1/16)th step/s for microstep modes
  80,              //Running current torque in % (from 0 to 100)
  40,              //Holding current torque in % (from 0 to 100)
  STEP_MODE_1_16,  //Step mode via enum motorStepMode_t
  FAST_DECAY,      //Decay mode via enum motorDecayMode_t
  0,               //Dwelling time in ms
  FALSE,           //Automatic HIZ STOP
  100000           //VREFA and VREFB PWM frequency (Hz)
};
Thread canrxa;

// Utility
InterruptIn button(USER_BUTTON);
DigitalOut led(LED1);

// Motor Control
L6208 *motor;

InterruptIn end0(PC_10, PullUp);
InterruptIn end1(PC_11, PullUp);
InterruptIn enc(PC_12, PullUp);

int current_pose = 0;
int pose = 0;

void motor_error_handler(uint16_t error)
{
  printf("ERROR: Motor Runtime\n\r");
  while(1){} 
}

void button_int_handler()
{
    printf("POSITION: %d\n\r", motor->get_position());
    
    motor->go_to(-160000);
}

void end0_int_handler()
{
  printf("END0: Pressed\n\rPOSITION: %d\n\r", motor->get_position());
}

void end1_int_handler()
{
  motor->hard_stop();

  motor->run(StepperMotor::BWD);

  printf("END1: Pressed\n\r");
}

void motor_set_home()
{
  motor->hard_stop();
  motor->set_home();
  motor->go_to(0);
  
  current_pose = 0;
  pose = 0;
}

void motor_zero()
{
  motor->run(StepperMotor::BWD);
}

// CAN
CAN can1(PA_11, PA_12);     // RX, TX

CANMessage messageIn;
CANMessage messageOut;

int filter = can1.filter(0x020, 0x4FF, CANStandard);

void canrx()
{
  printf("CAN: in\n\r");
  while(1){
  if(can1.read(messageIn, filter))
  {
   printf("CAN: mess %d\n\r", (messageIn.data[0] + (messageIn.data[1] << 8) + (messageIn.data[2] << 16) + (messageIn.data[3] << 24)));
        printf("CANaacc: id %x \n\r ",messageIn.id);
}
  }
}



/* Main ----------------------------------------------------------------------*/

int main()
{
  // Motor Initialization 
  motor = new L6208(D2, D8, D7, D4, D5, D6, VREFA_PWM_PIN, VREFB_PWM_PIN);
  
  if (motor->init(&init) != COMPONENT_OK)
  {
    printf("ERROR: vvMotor Init\n\r");
    exit(EXIT_FAILURE);
  }

  motor->attach_error_handler(&motor_error_handler);
  
  end0.rise(&end0_int_handler);
  end1.rise(&end1_int_handler);
  end1.fall(&motor_set_home);
  
  button.rise(&button_int_handler);
  
  printf("DONE: Mobjhbtor Init\n\r");
  
  // CAN Initialization
  //can1.reset();
 // can1.frequency(500000);
  //can1.attach(&can_rx_handler);
  
canrxa.start(canrx);
  printf("DONE: CAN Init\n\r");
  
  motor->run(StepperMotor::FWD);
  
  printf("Running!\n\r");
  
  while(true)
  {
    wait(1000);
  }
}