Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <nRF905.h>
- #include <SPI.h>
- #include <Servo.h>
- Servo myservo1;
- void setup()
- {
- // Start up
- nRF905_init();
- // Put into receive mode
- nRF905_receive();
- Serial.begin(9600);
- Serial.println(F("Server started"));
- }
- void loop()
- {
- Serial.println(F("Waiting for data..."));
- // Make buffer for data
- byte buffer[NRF905_MAX_PAYLOAD];
- // Wait for data
- while(!nRF905_getData(buffer, sizeof(buffer)));
- // Put back into receive mode
- nRF905_receive();
- Serial.println(F("Got data"));
- // Read values from payload
- int vals[5];
- for(byte i=0;i<5;i++)
- {
- vals[i] = buffer[i * 2] | (buffer[(i * 2) + 1]<<8);
- }
- Serial.println(vals[0]);
- int val = vals[1];
- if(val < 450)
- val = 450;
- else if(val > 770)
- val = 770;
- byte servoVal = map(val, 770, 450, 200, 0);
- myservo1.write(servoVal);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement