Форум arduino.ua

//--------------------------------------------------
//  name     : loop
//  in       : none 
//  out      : none
//  provide  : system supercycle
//-------------------------------------------------- 
void loop() 
{
 int ret_decode = 0;
 int len_data = 0;
 int angle_data;

 if ( JSON.STATUS == st_decode_data )
  { 
    ret_decode = func_decode_JSON( &out_data );
    //-------------------------------------
    switch ( ret_decode )
    {
     case tp_joy1:
     len_data =  vector_length_decode ( &out_data.joy );
     Serial.print ( "len = " );
     Serial.println( len_data );

     angle_data =  vector_angle_decode ( &out_data.joy );
     Serial.print ( "angle = " );
     Serial.println( angle_data );

     break;
     default: break; 
    }
    unlock_JSON();
  }
}

float vector_length_decode (  td_joy *data )
{
 float dx,dy;
 float ret; 

 dx = data->xy_begin[0] - data->xy_end[0]; 
 dy = data->xy_begin[1] - data->xy_end[1];
 
 dx = fabs ( dx );
 dy = fabs ( dy );

 // float data / core 8bit /  need change  
 ret = sqrt ( dx*dx + dy*dy );
 return ( ret );
}