NeerajRathi IUPUI/ECE
This is a Transmitter Code. Design and development of a wireless Robotic Arm that mirrors the movement of a hand in the horizontal and vertical direction. For this purpose, we have used FRDMk64F on board accelerometer that collects raw motion in terms of horizontal and vertical axis, processes it and sends it to another FRDM K64F wirelessly. On the other side this FRDM K64F processes the received data and sends a command to servo motor that moves the arms in the direction such a that it imitates the user’s hand.
Dependencies: DebounceIn FXOS8700Q mbed nRF24L01P
APPARATUS
1. Freescale development board – FRDM K64F
2. Servo Motors (3V to 6 V) DC
3. nRF24L01 – Wireless Trans-receiver
4. Gloves
5. USB cable
6. Gloves
7. Robotic arm MICROBOTLABS
Diff: main.cpp
- Revision:
- 0:c768464c8cbc
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Mon May 09 15:55:28 2016 +0000
@@ -0,0 +1,126 @@
+#include "mbed.h"
+#include "nRF24L01P.h"
+#include "FXOS8700Q.h"
+#include "DebounceIn.h"
+
+#define ACC_SAMPLE_SIZE 200
+#define ACC_X_GAIN 1
+#define ACC_Y_GAIN 2
+#define TRANSFER_SIZE 9
+
+Serial pc(USBTX, USBRX); // tx, rx
+
+nRF24L01P my_nrf24l01p(PTD6, PTD7, PTD5, PTD4, PTC12, PTC18); // mosi, miso, sck, csn, ce, irq
+FXOS8700Q_acc acc( PTE25, PTE24, FXOS8700CQ_SLAVE_ADDR1); // Proper Ports and I2C Address for K64F Freedom board
+
+DigitalOut myled1(LED1);
+DigitalOut myled2(LED2);
+DigitalOut myled3(LED3);
+MotionSensorDataCounts acc_raw;
+int16_t acc_x, acc_y;
+DebounceIn cal_button(PTC6);
+
+int main()
+{
+
+ char txData[TRANSFER_SIZE];
+ int txDataCnt = 0;
+
+ int acc_x_array[ACC_SAMPLE_SIZE];
+ int acc_y_array[ACC_SAMPLE_SIZE];
+ int acc_sample_cnt = 0;
+
+ int acc_x_avg = 0;
+ int acc_y_avg = 0;
+
+ int acc_x_cal = 0;
+ int acc_y_cal = 0;
+
+ pc.baud(115200);
+
+ my_nrf24l01p.setTxAddress(0xDEADBEEF0F);
+ my_nrf24l01p.powerUp();
+ myled1 = 1;
+ myled2 = 1;
+
+ pc.printf( "nRF24L01+ Frequency : %d MHz\r\n", my_nrf24l01p.getRfFrequency() );
+ pc.printf( "nRF24L01+ Output power : %d dBm\r\n", my_nrf24l01p.getRfOutputPower() );
+ pc.printf( "nRF24L01+ Data Rate : %d kbps\r\n", my_nrf24l01p.getAirDataRate() );
+ pc.printf( "nRF24L01+ TX Address : 0x%010llX\r\n", my_nrf24l01p.getTxAddress() );
+ pc.printf( "nRF24L01+ RX Address : 0x%010llX\r\n", my_nrf24l01p.getRxAddress() );
+
+ my_nrf24l01p.setTransferSize( TRANSFER_SIZE );
+ my_nrf24l01p.enable();
+
+ acc.enable();
+
+ myled3 = 0;
+
+ for (int x=0; x<ACC_SAMPLE_SIZE; x++)
+ {
+ acc_x_array[x]=0;
+ acc_y_array[x]=0;
+ }
+
+ while (1)
+ {
+ acc.getAxis(acc_raw);
+
+ acc_x = acc_raw.x - acc_x_cal;
+ acc_y = acc_raw.y - acc_y_cal;
+
+ acc_x_array[acc_sample_cnt]=(int)(acc_x>>2);
+ acc_y_array[acc_sample_cnt]=(int)(acc_y>>2);
+
+ acc_sample_cnt++;
+ if (acc_sample_cnt>=ACC_SAMPLE_SIZE) acc_sample_cnt = 0;
+
+ acc_x_avg=0;
+ acc_y_avg=0;
+ for (int x=0; x<ACC_SAMPLE_SIZE; x++)
+ {
+ acc_x_avg=acc_x_avg+acc_x_array[x];
+ acc_y_avg=acc_y_avg+acc_y_array[x];
+ }
+ acc_x_avg = (int)(acc_x_avg/ACC_SAMPLE_SIZE);
+ acc_y_avg = (int)(acc_y_avg/ACC_SAMPLE_SIZE);
+
+ pc.printf("%d (%d)\t%d (%d)\n\r",acc_x_avg,acc_raw.x,acc_y_avg,acc_raw.y);
+
+ txData[0] = (acc_x_avg) & 0xff;
+ txData[1] = (acc_x_avg>>8) & 0xff;
+ txData[2] = (acc_x_avg>>16) & 0xff;
+ txData[3] = (acc_x_avg>>24) & 0xff;
+
+ txData[4] = (acc_y_avg) & 0xff;
+ txData[5] = (acc_y_avg>>8) & 0xff;
+ txData[6] = (acc_y_avg>>16) & 0xff;
+ txData[7] = (acc_y_avg>>24) & 0xff;
+
+ my_nrf24l01p.write( NRF24L01P_PIPE_P0, txData, sizeof( txData ) );
+ pc.printf("sent data to rx");
+
+ wait(0.001);
+
+ if (cal_button.read()==0)
+ {
+ myled2 = 0;
+ myled3 = 1;
+
+ acc_x_avg=0;
+ acc_y_avg=0;
+ for (int x=0; x<ACC_SAMPLE_SIZE; x++)
+ {
+ acc.getAxis(acc_raw);
+ acc_x_avg=acc_x_avg+acc_raw.x;
+ acc_y_avg=acc_y_avg+acc_raw.y;
+ wait(0.01);
+ }
+ acc_x_cal = (int)(acc_x_avg/ACC_SAMPLE_SIZE);
+ acc_y_cal = (int)(acc_y_avg/ACC_SAMPLE_SIZE);
+ myled2 = 1;
+ myled3 = 0;
+ }
+
+ }
+}
\ No newline at end of file