WebSVN - Projects - Diff - Rev 50 and 117

 #define BUTTON_SELECT 26
 #define BUTTON_DOWN 28
 #define BUTTON_UP 27
+// #define AXIS_ROLL 0
+// #define AXIS_NICK 1
+// #define AXIS_GIER 5
+// #define AXIS_GAS  2
+// for x52
+/*
-#define AXIS_ROLL 0
+#define AXIS_ROLL 4
-#define AXIS_NICK 1
+#define AXIS_NICK 3
 #define AXIS_GIER 5
 #define AXIS_GAS  2
 #define INVERT_ROLL -1
+#define INVERT_NICK -1
+#define INVERT_GIER 1
+#define INVERT_GAS  -1
+*/
+#define AXIS_ROLL 0
+#define AXIS_NICK 1
+#define AXIS_GIER 3
+#define AXIS_GAS  2
+#define INVERT_ROLL 1
+#define INVERT_NICK -1
+#define INVERT_GIER 1
+#define INVERT_GAS  -1
+#include <stdio.h>
+#include <errno.h>
+#include <string.h>
+#include <sys/socket.h>
+#include <sys/types.h>
+#include <netinet/in.h>
+#include <unistd.h>//for close() for socket
-#define INVERT_NICK -1
+#define INPUT_NONE 0
-#define INVERT_GIER 1
+#define INPUT_JOYDEV 1
-#define INVERT_GAS  -1
+#define INPUT_EVDEV 2
   free( ii );
   close( sock );
+}
+ int yalv;           /* loop counter */
+    size_t read_bytes;  /* how many bytes were read */
+    struct input_event ev[64]; /* the events (up to 64 at once) */
+int evdev_fd;
+int connect_evdev()
+{
+  if ((evdev_fd = open("/dev/input/event10", O_RDONLY)) < 0) {
+        printf(" cant open evdev ");
+        return 0;
+    }
+  return 1;
+}
+int connect_joy()
+{
+  axis = (int *) calloc( 100, sizeof( int ) );
+  button = (char *)calloc( 100, sizeof( char ) );
+  button_trigger = (char *) calloc( 100, sizeof( char ) );
   //  axis = (int *) calloc( num_of_axis, sizeof( int ) );
-int connect_joy()
+  // button = (char *)calloc( num_of_buttons, sizeof( char ) );
   // button_trigger = (char *) calloc( num_of_buttons, sizeof( char ) );
+    }
   ioctl( x52_input_fd, JSIOCGAXES, &num_of_axis );
   ioctl( x52_input_fd, JSIOCGBUTTONS, &num_of_buttons );
-  ioctl( x52_input_fd, JSIOCGNAME(80), &name_of_joystick );
-  axis = (int *) calloc( num_of_axis, sizeof( int ) );
-  button = (char *)calloc( num_of_buttons, sizeof( char ) );
-  button_trigger = (char *) calloc( num_of_buttons, sizeof( char ) );
+  ioctl( x52_input_fd, JSIOCGNAME(80), &name_of_joystick );
   printf("Joystick detected: %s\n\t%d axis\n\t%d buttons\n\n"
          , name_of_joystick
+    }
+}
 int connect_mk(char dest[18])
+{
+  struct sockaddr_rc addr ;
+  struct sockaddr_in sa;
+ sa.sin_family = AF_INET;
+  sa.sin_addr.s_addr = htonl(0x0);
+  sa.sin_port = htons(54321);
+  // allocate a socket
+  //  s = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
+  s = socket(PF_INET, SOCK_STREAM, IPPROTO_TCP);
+  //);
+  // set the connection parameters (who to connect to)
+  addr.rc_family = AF_BLUETOOTH;
+  addr.rc_channel = 1;
+  str2ba( dest, &addr.rc_bdaddr );
+  // connect to server
+  //  status = connect(s, (struct sockaddr *)&addr, sizeof(addr));
+  status = connect(s,(struct sockaddr*) &sa, sizeof(struct sockaddr_in));
+  return status;
   /*
   struct sockaddr_rc addr ;
   // connect to server
   status = connect(s, (struct sockaddr *)&addr, sizeof(addr));
   return status;
   */
+}
 int r=0;
 int count=0;
 int connected=0;
 int r=0;
+        }
         printf("connected to QC at adress: %s\n",argv[1]);
         connected=1;
+    }
   int i;
-  printf("\nInitializing X-52 input ..\n");
-  if (!connect_joy()) return 0;
+  printf("\nInitializing X-52 input ..\n");
+  if (connect_joy())
+    {
+    printf(".. done");//
+    input=INPUT_JOYDEV;
+    }
+  else
+    printf(".. ERROR ");//
+  /*  printf("\nInitializing evdev input ..\n");
+  if (connect_evdev())
+    {
+    printf(".. done");//
+    input=INPUT_EVDEV;
+    }
-  printf(".. done");//
+  else
     printf(".. ERROR ");//
   */
       printf(" %d Devices found \n",bt_device_count);
+    }
+  int v_old;
+  int polls=0;
+  printf("starting loop ..\n");
   int v_old;
-  while( 1 )
+  while( 1 )
     {
-      // poll values from input device
       int polls=0;
+      switch (input)
+        {
-      for (polls=0;polls<100;polls++) // FIXME - better Polling
+        case INPUT_NONE:
-        {
+          printf("input none\n");
+          usleep(10000);
-          read(x52_input_fd, &x52_event_struct, sizeof(struct js_event));
+          break;
+        case INPUT_EVDEV:
+           printf("input evdev\n");
+          usleep(30000);
+        read_bytes = read(evdev_fd, ev, sizeof(struct input_event) * 64);
+           printf("read done\n");
+        if (read_bytes < (int) sizeof(struct input_event)) {
+            perror("evtest: short read");
+            exit (1);
+        }
-          /* see what to do with the event */
-          switch (x52_event_struct.type & ~JS_EVENT_INIT)
+        for (yalv = 0; yalv < (int) (read_bytes / sizeof(struct input_event)); yalv++)
             {
-            case JS_EVENT_AXIS:
+              // 1 -> nick
-              axis   [ x52_event_struct.number ] = x52_event_struct.value;
+              // 2 -> gas
+              // 4->roll
+              // 5-> gier
+              axis[ ev[yalv].code]= ev[yalv].value;
+              printf("nick:%d roll:%d gier:%d gas:%d\n",axis[3] , axis[4] , axis[5] , axis[2]);
+              /*if ( ev[yalv].code==5)
-              break;
+                printf("Event: time %ld.%06ld, type %d, code %d, value %d\n",
-            case JS_EVENT_BUTTON:
+                       ev[yalv].time.tv_sec, ev[yalv].time.tv_usec, ev[yalv].type,
-              button [ x52_event_struct.number ] = x52_event_struct.value;
-              break;
-            }
-        }
-      for( x=0 ; x<num_of_buttons ; ++x )
-        if( button[x]==0)
-          button_trigger[x]=0;
-        else
+                       ev[yalv].code, ev[yalv].value);
+              */
+            }
+          break;
+        case INPUT_JOYDEV:
+          printf("input joydev\n");
+          // poll values from input device
+          for (polls=0;polls<100;polls++) // FIXME - better Polling
+            {
+              read(x52_input_fd, &x52_event_struct, sizeof(struct js_event));
+              /* see what to do with the event */
+              switch (x52_event_struct.type & ~JS_EVENT_INIT)
+                {
+                case JS_EVENT_AXIS:
+                  axis   [ x52_event_struct.number ] = x52_event_struct.value;
+                  break;
+                case JS_EVENT_BUTTON:
+                  button [ x52_event_struct.number ] = x52_event_struct.value;
+                  break;
+                }
+            }
+          for( x=0 ; x<num_of_buttons ; ++x )
+            if( button[x]==0)
+              button_trigger[x]=0;
+            else
+              {
+                if (button_trigger[x]<100)button_trigger[x]++;
+              }
-            if (button_trigger[x]<100)button_trigger[x]++;
+          break;
           RxBuffer[1]=0;
+          //      ftime(&time_struct);
+          printf("waiting for confirm frame\n");
+          RxBuffer[2]=0;
-          //      ftime(&time_struct);
+          int confirm_misses=0;
           //printf("t:%d",time_struct.millitm);
-          while (RxBuffer[1]!='t')
+          while (RxBuffer[2]!='t')
             {
               r=0;
               in_char='#';
-              while(in_char!='\r')
+              while(in_char!='\n')
+                {
                   count=read(s,&in_char,1);
                   if (in_char!=0)
+                    {
                       RxBuffer[r++]=in_char;
                     }
                   else
+                    {
                       RxBuffer[r++]='0';
+                    }
+                  //               printf("\ncount:%d r:%d %d %c \n",count , r, in_char, in_char);
+                }
+              RxBuffer[r++]='\0';
+              printf("--->%s\n",RxBuffer);
+              // new
+              if (button_trigger[12]>1)
+                {
-                    }
+                  SendOutData('s', 0, (unsigned char *)&ExternControl, sizeof(ExternControl));
-                  //  printf("count:%d r:%d %d %c \n",count , r, in_char, in_char);
+                  button_trigger[12]=0;
+                }
-              RxBuffer[r++]='\0';
+              if (++confirm_misses>4)
-              printf("--->%s\n",RxBuffer);
+              SendOutData('b', 0, (unsigned char *)&ExternControl, sizeof(ExternControl));
+            }
           gettimeofday(&time_struct2,NULL);
+          printf("last trip: %d",(int)(time_struct1.tv_usec-time_struct2.tv_usec));
           act_mode=button[24] | (button[25]<<1);
           printf("last trip: %d",(int)(time_struct1.tv_usec-time_struct2.tv_usec));
-          act_mode=button[24] | (button[25]<<1);
+          switch (act_mode)
+            {
+            case 0:
+              act_nick=(axis[AXIS_NICK]>>8)*(INVERT_NICK);
+              act_roll=(axis[AXIS_ROLL]>>8)*(INVERT_ROLL);
+              act_gier=(axis[AXIS_GIER]>>8)*(INVERT_GIER);
-          switch (act_mode)
+              act_gas=((axis[AXIS_GAS]>>8)-128)*(-1);
-            case 0:
+              // clip gas
-              act_nick=(axis[AXIS_NICK]>>8)*(INVERT_NICK);
+              if (act_gas<0) act_gas=0;
           ExternControl.Digital[0]=0;
           ExternControl.Digital[1]=0;
           ExternControl.RemoteTasten=0;
           ExternControl.Nick=act_nick;  //(axis[1]>>8)*(-1)/2;
           //      printf("nick%d\n",ExternControl.Nick);
-          ExternControl.Roll=act_roll; //(axis[0]>>8)*(-1)/2;
+          ExternControl.Roll=act_roll*(-1); //(axis[0]>>8)*(-1)/2;
           ExternControl.Gier=(axis[5]>>8);
+          ExternControl.Gier=act_gier; // ************
           ExternControl.Gas=(axis[2]>>8)*(-1)+127;
+          ExternControl.Gas=act_gas; // ************
+          //      ExternControl.Gas=0; // ************
           ExternControl.Higt=0;
           ExternControl.free=0;
           ExternControl.Frame='t';
           ExternControl.Config=1;
-          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);
+          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);
           gettimeofday(&time_struct1,NULL);
           printf("sent data\n");
           // printf("sleeping\n");
-          // usleep(10000);
+          //      for (polls=0;polls<100;polls++) // FIXME - better Polling
           // printf("end_sleep\n");

Subversion Repositories Projects

(root)/Riddim/riddim.c @ 117 - Rev 50 → 117