00001 00002 #include <stdio.h> 00003 #include <string.h> 00004 #include <stdlib.h> 00005 00006 #ifdef USE_DCMOTOR2 00007 #include "dcmotor2.h" 00008 #else 00009 #include "dcmotor2.h" 00010 #endif 00011 00012 DC_MOTOR_STRUCT dcm; 00013 int skip_cycles=0; 00014 double cycle_time=0.1; 00015 00016 int main(int argc, const char **argv) 00017 { 00018 int i = 0; 00019 if(argc > 1) 00020 { 00021 cycle_time=strtod(argv[1],0); 00022 } 00023 if(argc > 2) 00024 { 00025 skip_cycles=strtol(argv[2],0,0); 00026 if(skip_cycles > 0) 00027 { 00028 cycle_time = cycle_time/(skip_cycles+1); 00029 } 00030 } 00031 dcmotorInit(&dcm); 00032 dcmotorSetCycleTime(&dcm, cycle_time); 00033 dcmotorIniLoad(&dcm,"sim.ini","AXIS_0"); 00034 dcmotorSetCycleTime(&dcm, cycle_time); 00035 dcmotorSetParameters(&dcm, dcm); 00036 00037 while(1) 00038 { 00039 for(i = 0; i < skip_cycles; i++) 00040 { 00041 dcmotorRunCycle(&dcm,1.0); 00042 } 00043 printf("%f\n",dcmotorRunCycle(&dcm,1.0)); 00044 } 00045 00046 }