Subversion Repositories Projects

Rev

Rev 488 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 488 Rev 505
Line 9... Line 9...
9
 *
9
 *
10
 **************************************************/
10
 **************************************************/
Line 11... Line 11...
11
 
11
 
Line 12... Line -...
12
#include "riddim.h"
-
 
13
 
12
#include "riddim.h"
Line 14... Line 13...
14
 
13
 
Line 214... Line 213...
214
  //  init_evdevstatus_led();
213
  //  init_evdevstatus_led();
Line 215... Line 214...
215
 
214
 
216
  while( TRUE )    
215
  while( TRUE )    
Line -... Line 216...
-
 
216
    {
-
 
217
 
-
 
218
      gettimeofday(&loop_start_time,NULL);
217
    {
219
 
218
 
220
 
219
      //      blink_evdev_led();
221
      //      blink_evdev_led();
Line 220... Line -...
220
      //       bt_host_tick(mk_socket);
-
 
221
      usleep(loop_delay);
-
 
222
 
222
      //       bt_host_tick(mk_socket);
Line 223... Line 223...
223
 
223
      usleep(loop_delay);
224
 
224
 
Line 368... Line 368...
368
              */
368
              */
369
            }
369
            }
370
          else
370
          else
371
            printf("not connected to mk\n");
371
            printf("not connected to mk\n");
Line 372... Line 372...
372
         
372
         
Line 373... Line 373...
373
          gettimeofday(&time_struct2,NULL);
373
          //      gettimeofday(&time_struct2,NULL);
374
 
374
 
Line 375... Line 375...
375
          printf("last trip: %d\n",(int)(time_struct2.tv_usec-time_struct1.tv_usec));
375
          //      printf("last trip: %d\n",(int)(time_struct2.tv_usec-time_struct1.tv_usec));
Line 392... Line 392...
392
          act_gier=0;
392
          act_gier=0;
Line 393... Line 393...
393
 
393
 
394
          int act_input=0;
394
          int act_input=0;
395
          for (act_input=0;act_input<input_count;act_input++)
395
          for (act_input=0;act_input<input_count;act_input++)
-
 
396
            {
-
 
397
 
396
            {
398
            printf("process b %d\n",inputs[act_input].nick_up_btn);
397
              //process buttons
399
              //process buttons
398
            if (inputs[act_input].nick_up_btn!=-1)
400
            if (inputs[act_input].nick_up_btn!=-1)
399
              {
401
              {
400
                if (inputs[act_input].evdev_button[inputs[act_input].nick_up_btn]!=0)
402
                if (inputs[act_input].evdev_button[inputs[act_input].nick_up_btn]!=0)
Line 401... Line 403...
401
                  act_nick=100;
403
                  act_nick=100;
Line -... Line 404...
-
 
404
               
402
               
405
              }
403
              }
406
 
404
 
407
 
405
            if (inputs[act_input].nick_down_btn!=-1)
408
            if (inputs[act_input].nick_down_btn!=-1)
Line 406... Line 409...
406
              {
409
              {
Line -... Line 410...
-
 
410
                if (inputs[act_input].evdev_button[inputs[act_input].nick_down_btn]!=0)
407
                if (inputs[act_input].evdev_button[inputs[act_input].nick_down_btn]!=0)
411
                  act_nick=-100;
408
                  act_nick=-100;
412
               
409
               
413
              }
410
              }
414
 
Line 419... Line 423...
419
            if (inputs[act_input].roll_right_btn!=-1)
423
            if (inputs[act_input].roll_right_btn!=-1)
420
              {
424
              {
421
                if (inputs[act_input].evdev_button[inputs[act_input].roll_right_btn]!=0)
425
                if (inputs[act_input].evdev_button[inputs[act_input].roll_right_btn]!=0)
422
                  act_roll=-100;
426
                  act_roll=-100;
Line -... Line 427...
-
 
427
               
423
               
428
 
Line 424... Line 429...
424
              }
429
              }
Line 425... Line 430...
425
 
430
 
Line 439... Line 444...
439
            if (inputs[act_input].rel_axis_gas!=-1)
444
            if (inputs[act_input].rel_axis_gas!=-1)
440
              act_gas=inputs[act_input].evdev_rel_axis[inputs[act_input].rel_axis_gas]*inputs[act_input].gas_mul;
445
              act_gas=inputs[act_input].evdev_rel_axis[inputs[act_input].rel_axis_gas]*inputs[act_input].gas_mul;
Line -... Line 446...
-
 
446
 
-
 
447
 
-
 
448
 
-
 
449
            if (inputs[act_input].rel_axis_alt!=-1)
-
 
450
             {
-
 
451
 
-
 
452
               if (inputs[act_input].evdev_rel_axis[inputs[act_input].rel_axis_alt]>300)
-
 
453
                  act_long_alt-=last_trip_time/100;
-
 
454
 
-
 
455
               if (inputs[act_input].evdev_rel_axis[inputs[act_input].rel_axis_alt]<-300)
-
 
456
                 act_long_alt+=last_trip_time/100;
-
 
457
                   
-
 
458
                act_alt=act_long_alt/1000;
-
 
459
 
-
 
460
                if (act_alt>120)act_alt=120;
-
 
461
                else if (act_alt<-120)act_alt=-120;
-
 
462
             }
-
 
463
            // process_events
-
 
464
           
-
 
465
            if (inputs[act_input].engine_switch_btn!=-1)
-
 
466
              {
-
 
467
               
-
 
468
                if ((inputs[act_input].evdev_button[inputs[act_input].engine_switch_btn]==0)&&(DebugOut.Analog[16]==1))
-
 
469
                  {
-
 
470
                    ExternEvent.key=2;
-
 
471
                    SendOutData('e', 0, (unsigned char *)&ExternEvent, sizeof(ExternEvent));
-
 
472
                  }
-
 
473
                if ((inputs[act_input].evdev_button[inputs[act_input].engine_switch_btn]!=0)&&(DebugOut.Analog[16]==0))
-
 
474
                  {
-
 
475
                    ExternEvent.key=1;
-
 
476
                    SendOutData('e', 0, (unsigned char *)&ExternEvent, sizeof(ExternEvent));
-
 
477
                  }
-
 
478
 
-
 
479
 
441
 
480
 
Line 442... Line 481...
442
 
481
              }
443
 
482
 
444
            }
483
            }
Line 509... Line 548...
509
            }
548
            }
510
          */  
549
          */  
511
          ExternControl.Digital[0]=0;
550
          ExternControl.Digital[0]=0;
512
          ExternControl.Digital[1]=0;
551
          ExternControl.Digital[1]=0;
513
          ExternControl.RemoteTasten=0;
552
          ExternControl.RemoteTasten=0;
514
          ExternControl.Higt=0;
553
          ExternControl.Higt=act_alt;
515
          ExternControl.free=0;
554
          ExternControl.free=0;
516
          ExternControl.Frame='t';
555
          ExternControl.Frame='t';
517
          ExternControl.Config=1;
556
          ExternControl.Config=1;
Line 523... Line 562...
523
          ExternControl.Gas=act_gas; // ************
562
          ExternControl.Gas=act_gas; // ************
524
          ExternControl.Gas=255; // ************
563
          ExternControl.Gas=255; // ************
Line 525... Line 564...
525
         
564
         
Line 526... Line 565...
526
 
565
 
527
 
566
 
528
          printf("act_mode %d , act_nick %d , act_roll %d , act_gier %d , act_gas %d",act_mode , act_nick  , act_roll  , act_gier , act_gas);
567
          printf("act_mode %d , act_nick %d , act_roll %d , act_gier %d , act_gas %d , act_alt %d",act_mode , act_nick  , act_roll  , act_gier , act_gas,act_alt);
529
 
568
 
Line 530... Line 569...
530
          if (connected)
569
          if (connected)
531
            {
570
            {
532
              complete_matches++;
571
              complete_matches++;
533
              printf("sending data\n");
572
              printf("sending data\n");
Line 534... Line 573...
534
             
573
             
535
              SendOutData('b', 0, (unsigned char *)&ExternControl, sizeof(ExternControl));
574
              SendOutData('b', 0, (unsigned char *)&ExternControl, sizeof(ExternControl));
Line 562... Line 601...
562
     
601
     
563
      printf("\n");
602
      printf("\n");
564
      fflush(stdout);
603
      fflush(stdout);
565
      printf("loop fin ( confirmed:%d misses:%d | debug_sets:%d )\n",complete_matches,complete_misses,debug_sets);
604
      printf("loop fin ( confirmed:%d misses:%d | debug_sets:%d )\n",complete_matches,complete_misses,debug_sets);
566
      printf("------------------------------------------------------------------------\n");
605
      printf("------------------------------------------------------------------------\n");
-
 
606
       
-
 
607
      gettimeofday(&loop_end_time,NULL);
-
 
608
      last_trip_time=(unsigned long)(loop_end_time.tv_usec-loop_start_time.tv_usec)+(unsigned long)(loop_end_time.tv_sec-loop_start_time.tv_sec)*1000000;
-
 
609
      printf("last trip: %d\n",last_trip_time);
-
 
610
 
567
               
611
       
Line 568... Line 612...
568
    }
612
    }
569
 
613