Subversion Repositories NaviCtrl

Rev

Rev 593 | Rev 612 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 593 Rev 603
Line 524... Line 524...
524 
                                                sprintf(string, "<BL_Temperature>%d,%d,%d,%d,%d,%d,%d,%d</BL_Temperature>\r\n",Motor[0].Temperature,Motor[1].Temperature,Motor[2].Temperature,Motor[3].Temperature,Motor[4].Temperature,Motor[5].Temperature,Motor[6].Temperature,Motor[7].Temperature);
 524 
                                                sprintf(string, "<BL_Temperature>%d,%d,%d,%d,%d,%d,%d,%d</BL_Temperature>\r\n",Motor[0].Temperature,Motor[1].Temperature,Motor[2].Temperature,Motor[3].Temperature,Motor[4].Temperature,Motor[5].Temperature,Motor[6].Temperature,Motor[7].Temperature);
525 
                                                fputs_(string, doc->file);
 525 
                                                fputs_(string, doc->file);
526 
                                                sprintf(string, "<MotorNOK>%d,%d,%d,%d,%d,%d,%d,%d</MotorNOK>\r\n",Motor[0].NotReadyCnt,Motor[1].NotReadyCnt,Motor[2].NotReadyCnt,Motor[3].NotReadyCnt,Motor[4].NotReadyCnt,Motor[5].NotReadyCnt,Motor[6].NotReadyCnt,Motor[7].NotReadyCnt);
 526 
                                                sprintf(string, "<MotorNOK>%d,%d,%d,%d,%d,%d,%d,%d</MotorNOK>\r\n",Motor[0].NotReadyCnt,Motor[1].NotReadyCnt,Motor[2].NotReadyCnt,Motor[3].NotReadyCnt,Motor[4].NotReadyCnt,Motor[5].NotReadyCnt,Motor[6].NotReadyCnt,Motor[7].NotReadyCnt);
527 
                                                fputs_(string, doc->file);
 527 
                                                fputs_(string, doc->file);
528 
                                                break;
 528 
                                                break;
- 
 
 529 
                                  case 10:
529 
                                  default:
 530 
                                  case 12:
530 
                                                sprintf(string, "<MotorCurrent>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</MotorCurrent>\r\n",BL3_Current(0),BL3_Current(1),BL3_Current(2),BL3_Current(3),BL3_Current(4),BL3_Current(5),BL3_Current(6),BL3_Current(7),BL3_Current(8),BL3_Current(9),BL3_Current(10),BL3_Current(11));
 531 
                                                sprintf(string, "<MotorCurrent>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</MotorCurrent>\r\n",BL3_Current(0),BL3_Current(1),BL3_Current(2),BL3_Current(3),BL3_Current(4),BL3_Current(5),BL3_Current(6),BL3_Current(7),BL3_Current(8),BL3_Current(9),BL3_Current(10),BL3_Current(11));
531 
                                                fputs_(string, doc->file);
 532 
                                                fputs_(string, doc->file);
532 
                                                sprintf(string, "<BL_Temperature>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</BL_Temperature>\r\n",Motor[0].Temperature,Motor[1].Temperature,Motor[2].Temperature,Motor[3].Temperature,Motor[4].Temperature,Motor[5].Temperature,Motor[6].Temperature,Motor[7].Temperature,Motor[8].Temperature,Motor[9].Temperature,Motor[10].Temperature,Motor[11].Temperature);
 533 
                                                sprintf(string, "<BL_Temperature>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</BL_Temperature>\r\n",Motor[0].Temperature,Motor[1].Temperature,Motor[2].Temperature,Motor[3].Temperature,Motor[4].Temperature,Motor[5].Temperature,Motor[6].Temperature,Motor[7].Temperature,Motor[8].Temperature,Motor[9].Temperature,Motor[10].Temperature,Motor[11].Temperature);
533 
                                                fputs_(string, doc->file);
 534 
                                                fputs_(string, doc->file);
534 
                                                sprintf(string, "<MotorNOK>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</MotorNOK>\r\n",Motor[0].NotReadyCnt,Motor[1].NotReadyCnt,Motor[2].NotReadyCnt,Motor[3].NotReadyCnt,Motor[4].NotReadyCnt,Motor[5].NotReadyCnt,Motor[6].NotReadyCnt,Motor[7].NotReadyCnt,Motor[8].NotReadyCnt,Motor[9].NotReadyCnt,Motor[10].NotReadyCnt,Motor[11].NotReadyCnt);
 535 
                                                sprintf(string, "<MotorNOK>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</MotorNOK>\r\n",Motor[0].NotReadyCnt,Motor[1].NotReadyCnt,Motor[2].NotReadyCnt,Motor[3].NotReadyCnt,Motor[4].NotReadyCnt,Motor[5].NotReadyCnt,Motor[6].NotReadyCnt,Motor[7].NotReadyCnt,Motor[8].NotReadyCnt,Motor[9].NotReadyCnt,Motor[10].NotReadyCnt,Motor[11].NotReadyCnt);
535 
                                                fputs_(string, doc->file);
 536 
                                                fputs_(string, doc->file);
536 
                                                break;
 537 
                                                break;
- 
 
 538 
                                  default:
- 
 
 539 
                                                sprintf(string, "<MotorCurrent>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</MotorCurrent>\r\n",BL3_Current(0),BL3_Current(1),BL3_Current(2),BL3_Current(3),BL3_Current(4),BL3_Current(5),BL3_Current(6),BL3_Current(7),BL3_Current(8),BL3_Current(9),BL3_Current(10),BL3_Current(11),BL3_Current(1),BL3_Current(13),BL3_Current(14),BL3_Current(15));
- 
 
 540 
                                                fputs_(string, doc->file);
- 
 
 541 
                                                sprintf(string, "<BL_Temperature>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</BL_Temperature>\r\n",Motor[0].Temperature,Motor[1].Temperature,Motor[2].Temperature,Motor[3].Temperature,Motor[4].Temperature,Motor[5].Temperature,Motor[6].Temperature,Motor[7].Temperature,Motor[8].Temperature,Motor[9].Temperature,Motor[10].Temperature,Motor[11].Temperature,Motor[12].Temperature,Motor[13].Temperature,Motor[14].Temperature,Motor[15].Temperature);
- 
 
 542 
                                                fputs_(string, doc->file);
- 
 
 543 
                                                sprintf(string, "<MotorNOK>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</MotorNOK>\r\n",Motor[0].NotReadyCnt,Motor[1].NotReadyCnt,Motor[2].NotReadyCnt,Motor[3].NotReadyCnt,Motor[4].NotReadyCnt,Motor[5].NotReadyCnt,Motor[6].NotReadyCnt,Motor[7].NotReadyCnt,Motor[8].NotReadyCnt,Motor[9].NotReadyCnt,Motor[10].NotReadyCnt,Motor[11].NotReadyCnt,Motor[12].NotReadyCnt,Motor[13].NotReadyCnt,Motor[14].NotReadyCnt,Motor[15].NotReadyCnt);
- 
 
 544 
                                                fputs_(string, doc->file);
- 
 
 545 
                                                break;
537 
                                  }
 546 
                                  }
538 
                           break;
 547 
                           break;
539 
                           case 6:
 548 
                           case 6:
540 
/*                              sprintf(string, "<BL_State>0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x</BL_State>\r\n",Motor.State[0],Motor.State[1],Motor.State[2],Motor.State[3],Motor.State[4],Motor.State[5],Motor.State[6],Motor.State[7],Motor.State[8],Motor.State[9],Motor.State[10],Motor.State[11]);
 549 
/*                              sprintf(string, "<BL_State>0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x</BL_State>\r\n",Motor.State[0],Motor.State[1],Motor.State[2],Motor.State[3],Motor.State[4],Motor.State[5],Motor.State[6],Motor.State[7],Motor.State[8],Motor.State[9],Motor.State[10],Motor.State[11]);
541 
                                fputs_(string, doc->file);
 550 
                                fputs_(string, doc->file);
Line 571... Line 580...
571 
                                        }
 580 
                                        }
572 
                                 }
 581 
                                 }
573 
                                sprintf(string, "<WP>%s,%d,%d,%d</WP>\r\n",name,NaviData.WaypointIndex,NaviData.WaypointNumber,LogFC_WP_EventChannel);   // x of y Waypoints and the actual value of the Event Channel
 582 
                                sprintf(string, "<WP>%s,%d,%d,%d</WP>\r\n",name,NaviData.WaypointIndex,NaviData.WaypointNumber,LogFC_WP_EventChannel);   // x of y Waypoints and the actual value of the Event Channel
574 
                                LogFC_WP_EventChannel = 0; // can be cleared now
 583 
                                LogFC_WP_EventChannel = 0; // can be cleared now
575 
                                fputs_(string, doc->file);
 584 
                                fputs_(string, doc->file);
- 
 
 585 
                                sprintf(string, "<ShutterCnt>%d</ShutterCnt>\r\n",NaviData_Volatile.ShutterCounter);   
- 
 
 586 
                                LogFC_WP_EventChannel = 0; // can be cleared now
- 
 
 587 
                                fputs_(string, doc->file);
576 
                           break;
 588 
                           break;
577 
                           case 7:
 589 
                           case 7:
578 
                                // Target Bearing in deg
 590 
                                // Target Bearing in deg
579 
                                sprintf(string, "<TargetBearing>%03d</TargetBearing>\r\n", NaviData.TargetPositionDeviation.Bearing);
 591 
                                sprintf(string, "<TargetBearing>%03d</TargetBearing>\r\n", NaviData.TargetPositionDeviation.Bearing);
580 
                                fputs_(string, doc->file);
 592 
                                fputs_(string, doc->file);