Diff: main.cpp

Revision:

3:8a9407817ba9

Parent:

2:fb9508744bc4

Child:

4:53ef39fbf9d9

--- a/main.cpp	Tue Feb 07 09:50:51 2017 +0000
+++ b/main.cpp	Wed Feb 08 00:11:41 2017 +0800
@@ -17,6 +17,11 @@
     rt=dxl_initialize( 1, 1);
     pc.printf("dxl_initialize rt=%d\n",rt);
 
+	int nnn=-100;
+	pc.printf("nnn=%d\n",nnn);
+
+	nnn=-1000;
+	pc.printf("nnn=%d\n",nnn);
     myled = 0; // LED is ON
     
     /**************************
@@ -25,21 +30,26 @@
     //dxl_write_byte(3,ADDRESS_LED,0);
     //dxl_ping(3);
     
-   
+   short int pos=0; //16bit
     while(1)
     {
         
-    pc.printf("before=%d\n",rt);
+		//pc.printf("before=%d\n",rt);
     
         //dxl_write_word(3,GOAL_POSITION,400);
-        setPosition(3,2048,10);
-         pc.printf("after=%d\n",rt);
+        //setPosition(3,2048,10);
+         //pc.printf("after=%d\n",rt);
         //myled = 1; // LED is ON
-        wait(4);
+        //wait(4);
         //dxl_write_word(3,GOAL_POSITION,-400);
-        setPosition(3,-2048,10);
+        //setPosition(3,-2048,10);
         //myled = 0; // LED is ON
-        wait(4);
+        //wait(4);
+		
+		pos=dxl_read_word(3,PRESENT_POS);
+		pc.printf("pos=%d\n",pos);
+		wait_ms(200);
+
         
     }
 }
\ No newline at end of file