[tuxdroid-svn] r143 - daemon/trunk/libs

[remi <c2m...@c2...>]

Author: remi
Date: 2007-03-09 14:25:16 +0100 (Fri, 09 Mar 2007)
New Revision: 143

Modified:
   daemon/trunk/libs/USBDaemon_status_table.c
Log:
UPD : updating of the statutes

Modified: daemon/trunk/libs/USBDaemon_status_table.c
===================================================================
--- daemon/trunk/libs/USBDaemon_status_table.c	2007-03-09 13:21:58 UTC (rev 142)
+++ daemon/trunk/libs/USBDaemon_status_table.c	2007-03-09 13:25:16 UTC (rev 143)
@@ -325,18 +325,6 @@
             }
             tcp_server_send_raw(tcp_trame, 16);
         }
-        // head push position motor
-        if((portb.Byte&0x20)!=(new_value&0x20)){
-            tcp_trame[4]=DATA_STATUS_HEAD_PUSH_POSITION;
-            if (portb.bits.PB5){
-                printf("head push position 0\n");
-                tcp_trame[5]=0;
-            }else{
-                printf("head push position 1\n");
-                tcp_trame[5]=1;
-            }
-            tcp_server_send_raw(tcp_trame, 16);
-        }
         // charger inhibit signal
         if((portb.Byte&0x40)!=(new_value&0x40)){
             tcp_trame[4]=DATA_STATUS_CHARGER_INHIBIT_SIGNAL ;
@@ -370,9 +358,9 @@
         tcp_trame[2]=DATA_TP_RSP;
         tcp_trame[3]=SUBDATA_TP_STATUS;
         // wings position switch
-        if((portc.Byte&0x01)!=(new_value&0x01)){
-            tcp_trame[4]=DATA_STATUS_WINGS_POSITION_SWITCH  ;
-            if (portc.bits.PB0){
+        if((portc.Byte&0x02)!=(new_value&0x02)){
+            tcp_trame[4]=DATA_STATUS_WINGS_POSITION_SWITCH;
+            if (portc.bits.PB1){
                 printf("wings position switch 0\n");
                 tcp_trame[5]=0;
             }else{
@@ -381,18 +369,6 @@
             }
             tcp_server_send_raw(tcp_trame, 16);
         }
-        // motor for wings
-        if((portc.Byte&0x02)!=(new_value&0x02)){
-            tcp_trame[4]=DATA_STATUS_MOTOR_FOR_WINGS;
-            if (portc.bits.PB1){
-                printf("motor for wings off\n");
-                tcp_trame[5]=0;
-            }else{
-                printf("motor for wings on\n");
-                tcp_trame[5]=1;
-            }
-            tcp_server_send_raw(tcp_trame, 16);
-        }
         // right blue led
         if((portc.Byte&0x04)!=(new_value&0x04)){
             tcp_trame[4]=DATA_STATUS_RIGHT_BLUE_LED;
@@ -642,7 +618,6 @@
         sensors2.light_mode.Byte=new_light_mode;
         tcp_trame[5]=new_value_high;
         tcp_trame[6]=new_value_low;
-        //tcp_server_send_raw(tcp_trame, 16);
     }
     
     // ***********************************************************************
@@ -665,18 +640,24 @@
         tcp_trame[2]=DATA_TP_RSP;
         tcp_trame[3]=SUBDATA_TP_STATUS;
         
-        position1.eyes_position.Byte=eyes_position;
-        position1.mouth_position.Byte=mouth_position;
-        position1.wings_position.Byte=wings_position;
-        tcp_trame[4]=DATA_STATUS_EYES_POSITION_COUNTER;
-        tcp_trame[5]=eyes_position;
-        tcp_server_send_raw(tcp_trame, 16);
-        tcp_trame[4]=DATA_STATUS_MOUTH_POSITION_COUNTER;
-        tcp_trame[5]=mouth_position;
-        tcp_server_send_raw(tcp_trame, 16);
-        tcp_trame[4]=DATA_STATUS_WINGS_POSITION_COUNTER;
-        tcp_trame[5]=wings_position;
-        tcp_server_send_raw(tcp_trame, 16);
+        if(position1.eyes_position.Byte!=eyes_position){
+            position1.eyes_position.Byte=eyes_position;
+            tcp_trame[4]=DATA_STATUS_EYES_POSITION_COUNTER;
+            tcp_trame[5]=eyes_position;
+            tcp_server_send_raw(tcp_trame, 16);
+        }
+        if(position1.mouth_position.Byte!=mouth_position){
+            position1.mouth_position.Byte=mouth_position;
+            tcp_trame[4]=DATA_STATUS_MOUTH_POSITION_COUNTER;
+            tcp_trame[5]=mouth_position;
+            tcp_server_send_raw(tcp_trame, 16);
+        }
+        if(position1.wings_position.Byte!=wings_position){
+            position1.wings_position.Byte=wings_position;
+            tcp_trame[4]=DATA_STATUS_WINGS_POSITION_COUNTER;
+            tcp_trame[5]=wings_position;
+            tcp_server_send_raw(tcp_trame, 16);
+        }
     }
     
     // ***********************************************************************