Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <ipst.h>
- int i=0;
- char x[13];
- void setup(){
- // Send Reset Command
- out(17,0);delay(100);
- out(17,1);delay(1000);
- // Baudrate 2400
- Serial1.begin(2400);
- // Read ZX-SERVO16i Version
- Serial1.println("!SCVER?");
- while(!Serial1.available());
- delay(300);
- while(Serial1.available()>0){
- x[i]=Serial1.read();
- i++;
- }
- // Show at GLCD line 1
- glcd(0,0,x);
- i=0;
- // Change ZX-SERVO16i baudrate to 38400
- Serial1.print("!SCSBR");
- Serial1.write(1);
- Serial1.write(0x0D);
- Serial1.write(0x0A);
- delay(1000);
- // Change baudrate to 38400
- Serial1.end();
- Serial1.begin(38400);
- // Check VERSION again
- Serial1.println("!SCVER?");
- while(!Serial1.available());
- delay(100);
- while(Serial1.available()>0){
- x[i]=Serial1.read();
- i++;
- }
- // Show GLCD line 3
- glcd(2,0,x);
- }
- void loop(){}
Advertisement
Add Comment
Please, Sign In to add comment