Ejemplo n.º 1
0
void main(){
car_init();
while(1){
    sensor_accelerator_read();
  sensor_accelerator_calculate();
  sensor_electromagnet_read();
 angle_control(0);
 // Speed_R=10;Speed_L=10;
  float  OutData[4];

  OutData[0] = angle;
  //OutData[1] =  angle_accZ;
  OutData[2] = 3 ;
  OutData[3] = 4;
  //vcan_sendware((uint8_t *)OutData,sizeof(OutData));
 print_fraction(angle);

}


}
Ejemplo n.º 2
0
void  main1(void)
{
  
 OLED_Init();
  OLED_Fill(0x00);//黑屏
  car_init();
  
  OLED_P8x16Str(5,0,"test");
  
  
  
  //setup();
  //sd_read();
  
  while(1){
  sensor_accelerator_read();
  sensor_accelerator_calculate();
  char buffer [100] ;
  float  OutData[1];
   // OutData[0]=angle;
 // vcan_sendware((char *)OutData,sizeof(OutData));
  sprintf(buffer,"%d",(int)angle);
  //OLED_P8x16Str(5,0,"    ");

  //OLED_P8x16Str(6,0,buffer);
 //motor_left_pid(1);
 //motor_right_pid(0);
  angle_control(20);
  //sensor_electromagnet_read();
  
  //printf("%lld\n",electromagnet_L6);
  
  }

 
}
Ejemplo n.º 3
0
void set_angle(angle_t angle)
{
    angle_control(angle);
}