Subversion Repositories Projects

Rev

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

Rev 130 Rev 140
Line 2... Line 2...
2
 
2
 
3
 
3
 
Line 4... Line 4...
4
unsigned char TxBuffer[150];
4
unsigned char TxBuffer[150];
5
unsigned char _TxBuffer[150];
5
unsigned char _TxBuffer[150];
Line 6... Line 6...
6
 
6
 
Line 81... Line 81...
81
}
81
}
Line 82... Line 82...
82
 
82
 
Line -... Line 83...
-
 
83
 
-
 
84
int rx_last_length;
-
 
85
 
-
 
86
 
-
 
87
void Decode64(unsigned char *ptrOut, unsigned char len, unsigned char ptrIn,unsigned char max)
-
 
88
{
-
 
89
 unsigned char a,b,c,d;
-
 
90
 unsigned char ptr = 0;
-
 
91
 unsigned char x,y,z;
-
 
92
 while(len)
-
 
93
  {
-
 
94
   a = RxBuffer[ptrIn++] - '=';
-
 
95
   b = RxBuffer[ptrIn++] - '=';
-
 
96
   c = RxBuffer[ptrIn++] - '=';
-
 
97
   d = RxBuffer[ptrIn++] - '=';
-
 
98
   if(ptrIn > max - 2) break;    
-
 
99
 
-
 
100
   x = (a << 2) | (b >> 4);
-
 
101
   y = ((b & 0x0f) << 4) | (c >> 2);
-
 
102
   z = ((c & 0x03) << 6) | d;
-
 
103
 
-
 
104
   if(len--) ptrOut[ptr++] = x; else break;
-
 
105
   if(len--) ptrOut[ptr++] = y; else break;
-
 
106
   if(len--) ptrOut[ptr++] = z; else break;
-
 
107
  }
83
 
108
 
84
int rx_last_length;
109
}
85
 
110
 
86
int read_from_mk()
111
int read_from_mk()
87
{      
112
{      
-
 
113
  char in_char='#';
88
  char in_char='#';
114
  int count=0;
89
  int count=0;
115
  int r=0;
90
  int r=0;
116
  int i=0;
91
 
117
 
92
  printf("starting read\n");
118
  printf("starting read\n");
93
  while(in_char!='\n')
119
  while(in_char!='\n')
Line 110... Line 136...
110
  rx_last_length=r;
136
  rx_last_length=r;
111
  PrintableRxBuffer[r++]='\0'; // terminate 
137
  PrintableRxBuffer[r++]='\0'; // terminate 
112
  printf("done --->%s\n",PrintableRxBuffer);
138
  printf("done --->%s\n",PrintableRxBuffer);
Line 113... Line 139...
113
 
139
 
-
 
140
  if (RxBuffer[2]=='D')
114
  if (RxBuffer[2]=='D')
141
    {
-
 
142
      debug_sets++;
-
 
143
      Decode64((unsigned char *) &DebugOut,sizeof(DebugOut),3,rx_last_length);
115
    debug_sets++;
144
      printf("decoded FC Debug data height:%d\n",DebugOut.Analog[5]);
116
 
145
    }
117
  return 1;
146
  return 1;
Line 118... Line 147...
118
}
147
}