X-Git-Url: http://git.rot13.org/?a=blobdiff_plain;ds=sidebyside;f=firmware%2Flib%2Fcommand.c;h=a8265714137218a416f9b6b040dde5f7113046df;hb=08c1c58408da4d21b9060430ef4a9d402eb70dd0;hp=c9c1b1cbbbc7a523906598fe0e72b089a062dc74;hpb=6a87a627534bd71abda0c446269dd03c5cad4a42;p=goodfet

diff --git a/firmware/lib/command.c b/firmware/lib/command.c
index c9c1b1c..a826571 100644
--- a/firmware/lib/command.c
+++ b/firmware/lib/command.c
@@ -1,16 +1,120 @@
-//! Different command handling functions.
+/*! \file command.c
+  \author Travis Goodspeed
+  \brief These functions manage command interpretation.
+*/
 
-unsigned char cmddata[256];
+#include "command.h"
+#include "platform.h"
+#include <string.h>
 
-//!Transmit data.
-void txdata(unsigned char app,
+unsigned char cmddata[CMDDATALEN];
+unsigned char silent=0;
+
+//! Transmit a string.
+void txstring(unsigned char app,
+	      unsigned char verb,
+	      const char *str){
+  unsigned long len=strlen(str);
+  txhead(app,verb,len);
+  while(len--)
+    serial_tx(*(str++));
+}
+
+/*! \brief Transmit a debug string.
+  
+  Transmits a debugging string that is to be printed
+  out of line by the client.  This is just for record-keeping;
+  it is not considered a proper reply to a query.
+ */
+void debugstr(const char *str){
+  txstring(0xFF,0xFF,str);
+}
+
+/*! \brief Transmit debug bytes.
+  
+  Transmits bytes for debugging.
+*/
+void debugbytes(const char *bytes, unsigned int len){
+  u16 i;
+  txhead(0xFF,0xFE,len);
+  for(i=0;i<len;i++)
+    serial_tx(bytes[i]);
+}
+
+
+//! Transmit a header.
+void txhead(unsigned char app,
 	    unsigned char verb,
-	    unsigned char len){
-  unsigned int i=0;
+	    unsigned long len){
   serial_tx(app);
   serial_tx(verb);
-  serial_tx(len);
+  //serial_tx(len); //old protocol
+  txword(len);
+}
+
+//! Transmit data.
+void txdata(unsigned char app,
+	    unsigned char verb,
+	    unsigned long len){
+  unsigned int i=0;
+  if(silent)
+    return;
+  txhead(app,verb,len);
   for(i=0;i<len;i++){
     serial_tx(cmddata[i]);
   }
 }
+
+//! Receive a long.
+unsigned long rxlong(){
+  unsigned long toret=0;
+  toret=serial_rx();
+  toret|=(((long)serial_rx())<<8);
+  toret|=(((long)serial_rx())<<16);
+  toret|=(((long)serial_rx())<<24);
+  return toret;
+}
+//! Receive a word.
+unsigned int rxword(){
+  unsigned long toret=0;
+  toret=serial_rx();
+  toret|=(((long)serial_rx())<<8);
+  return toret;
+}
+//! Transmit a long.
+void txlong(unsigned long l){
+  serial_tx(l&0xFF);
+  l>>=8;
+  serial_tx(l&0xFF);
+  l>>=8;
+  serial_tx(l&0xFF);
+  l>>=8;
+  serial_tx(l&0xFF);
+  l>>=8;
+}
+//! Transmit a word.
+void txword(unsigned int l){
+  serial_tx(l&0xFF);
+  l>>=8;
+  serial_tx(l&0xFF);
+  l>>=8;
+}
+
+//Be very careful changing delay().
+//It was chosen poorly by trial and error.
+
+//! Delay for a count.
+void delay(unsigned int count){
+  volatile unsigned int i=count;
+  while(i--) asm("nop");
+}
+//! MSDelay
+void msdelay(unsigned int ms){
+  volatile unsigned int i,j;
+  i=100;
+  while(i--){
+    j=ms;
+    while(j--) asm("nop");
+  }
+  //Using TimerA might be cleaner.
+}