/*************************************************************** * * OpenBeacon.org - main file for OpenBeacon Sensor (CR123A) * * Copyright 2010 Milosch Meriac * *************************************************************** This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; version 2. This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program; if not, write to the Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. */ #include #include "3d_acceleration.h" #include "sound.h" #include "xxtea.h" #include "pmu.h" #include "iap.h" #include "spi.h" #include "nRF_API.h" #include "nRF_CMD.h" #include "openbeacon-proto.h" uint32_t g_sysahbclkctrl; #define FIFO_DEPTH 10 typedef struct { int x,y,z; } TFifoEntry; #define MAINCLKSEL_IRC 0 #define MAINCLKSEL_SYSPLL_IN 1 #define MAINCLKSEL_WDT 2 #define MAINCLKSEL_SYSPLL_OUT 3 /* device UUID */ static uint16_t tag_id; static TDeviceUID device_uuid; /* OpenBeacon packet */ static TBeaconEnvelope g_Beacon; /* Default TEA encryption key of the tag - MUST CHANGE ! */ static const uint32_t xxtea_key[4] = { 0x00112233, 0x44556677, 0x8899AABB, 0xCCDDEEFF }; /* set nRF24L01 broadcast mac */ static const unsigned char broadcast_mac[NRF_MAX_MAC_SIZE] = { 1, 2, 3, 2, 1 }; static void nRF_tx (uint8_t power) { /* encrypt data */ xxtea_encode(g_Beacon.block, XXTEA_BLOCK_COUNT, xxtea_key); /* set TX power */ nRFAPI_SetTxPower (power & 0x3); /* upload data to nRF24L01 */ nRFAPI_TX ((uint8_t*)&g_Beacon, sizeof(g_Beacon)); /* transmit data */ nRFCMD_CE (1); /* wait for packet to be transmitted */ pmu_sleep_ms (10); /* transmit data */ nRFCMD_CE (0); } void nrf_off (void) { /* disable RX mode */ nRFCMD_CE (0); /* wait till RX is done */ pmu_sleep_ms (5); /* switch to TX mode */ nRFAPI_SetRxMode (0); } int main (void) { /* accelerometer readings fifo */ TFifoEntry acc_lowpass; TFifoEntry fifo_buf[FIFO_DEPTH]; int fifo_pos; TFifoEntry *fifo; uint32_t seq; volatile int i; int x, y, z, firstrun, tamper, moving; /* wait on boot - debounce */ for (i = 0; i < 2000000; i++); /* Initialize GPIO (sets up clock) */ GPIOInit (); /* initialize power management */ pmu_init (); /* NVIC is installed inside UARTInit file. */ UARTInit (115200, 0); LPC_IOCON->PIO2_0 = 0; GPIOSetDir (2, 0, 1); //OUT GPIOSetValue (2, 0, 0); LPC_IOCON->RESET_PIO0_0 = 0; GPIOSetDir (0, 0, 0); //IN LPC_IOCON->PIO0_1 = 0; GPIOSetDir (0, 1, 0); //IN LPC_IOCON->PIO1_8 = 0; GPIOSetDir (1, 8, 1); //OUT GPIOSetValue (1, 8, 0); LPC_IOCON->PIO0_2 = 0; GPIOSetDir (0, 2, 1); //OUT GPIOSetValue (0, 2, 0); LPC_IOCON->PIO0_3 = 0; GPIOSetDir (0, 3, 0); //IN LPC_IOCON->PIO0_4 = 1 << 8; GPIOSetDir (0, 4, 1); //OUT GPIOSetValue (0, 4, 1); LPC_IOCON->PIO0_5 = 1 << 8; GPIOSetDir (0, 5, 1); //OUT GPIOSetValue (0, 5, 1); LPC_IOCON->PIO1_9 = 0; //FIXME GPIOSetDir (1, 9, 1); //OUT GPIOSetValue (1, 9, 0); LPC_IOCON->PIO0_6 = 0; GPIOSetDir (0, 6, 1); //OUT GPIOSetValue (0, 6, 1); LPC_IOCON->PIO0_7 = 0; GPIOSetDir (0, 7, 1); //OUT GPIOSetValue (0, 7, 0); /* select UART_TXD */ LPC_IOCON->PIO1_7 = 1; LPC_IOCON->PIO1_6 = 0; GPIOSetDir (1, 6, 1); //OUT GPIOSetValue (1, 6, 0); LPC_IOCON->PIO1_5 = 0; GPIOSetDir (1, 5, 1); //OUT GPIOSetValue (1, 5, 0); LPC_IOCON->PIO3_2 = 0; // FIXME GPIOSetDir (3, 2, 1); //OUT GPIOSetValue (3, 2, 1); LPC_IOCON->PIO1_11 = 0x80; //FIXME GPIOSetDir (1, 11, 1); // OUT GPIOSetValue (1, 11, 0); LPC_IOCON->PIO1_4 = 0x80; GPIOSetDir (1, 4, 0); // IN LPC_IOCON->ARM_SWDIO_PIO1_3 = 0x81; GPIOSetDir (1, 3, 1); // OUT GPIOSetValue (1, 3, 0); LPC_IOCON->JTAG_nTRST_PIO1_2 = 0x81; GPIOSetDir (1, 2, 1); // OUT GPIOSetValue (1, 2, 0); LPC_IOCON->JTAG_TDO_PIO1_1 = 0x81; GPIOSetDir (1, 1, 1); // OUT GPIOSetValue (1, 1, 0); LPC_IOCON->JTAG_TMS_PIO1_0 = 0x81; GPIOSetDir (1, 0, 1); // OUT GPIOSetValue (1, 0, 0); LPC_IOCON->JTAG_TDI_PIO0_11 = 0x81; GPIOSetDir (0, 11, 1); // OUT GPIOSetValue (0, 11, 0); LPC_IOCON->PIO1_10 = 0x80; GPIOSetDir (1, 10, 1); // OUT GPIOSetValue (1, 10, 1); LPC_IOCON->JTAG_TCK_PIO0_10 = 0x81; GPIOSetDir (0, 10, 1); // OUT GPIOSetValue (0, 10, 0); LPC_IOCON->PIO0_9 = 0; GPIOSetDir (0, 9, 1); // OUT GPIOSetValue (0, 9, 0); /* select MISO function for PIO0_8 */ LPC_IOCON->PIO0_8 = 1; /* initialize SPI */ spi_init (); #ifdef SOUND_ENABLE /* Init Speaker Output */ snd_init (); #endif /*SOUND_ENABLE */ /* Init 3D acceleration sensor */ acc_init (0); /* read device UUID */ bzero (&device_uuid, sizeof (device_uuid)); iap_read_uid (&device_uuid); tag_id = crc16 ((uint8_t *) & device_uuid, sizeof (device_uuid)); /* Initialize OpenBeacon nRF24L01 interface */ if (!nRFAPI_Init (81, broadcast_mac, sizeof (broadcast_mac), 0)) for (;;) { GPIOSetValue (1, 3, 1); pmu_sleep_ms (100); GPIOSetValue (1, 3, 0); pmu_sleep_ms (400); } /* set tx power power to high */ nRFCMD_Power (1); /* blink LED for 1s to show readyness */ GPIOSetValue (1, 3, 1); pmu_sleep_ms (1000); GPIOSetValue (1, 3, 0); /* reset fifo */ fifo_pos=0; bzero(&fifo_buf,sizeof(fifo_buf)); bzero(&acc_lowpass,sizeof(acc_lowpass)); seq = firstrun = tamper = moving = 0; while (1) { /* read acceleration sensor */ nRFAPI_SetRxMode(0); acc_power (1); pmu_sleep_ms (20); acc_xyz_read (&x, &y, &z); acc_power (0); /* prepare packet */ bzero (&g_Beacon, sizeof (g_Beacon)); g_Beacon.pkt.proto = RFBPROTO_BEACONTRACKER; g_Beacon.pkt.oid = htons (tag_id); g_Beacon.pkt.p.tracker.strength = 5; g_Beacon.pkt.p.tracker.seq = htonl (seq++); g_Beacon.pkt.p.tracker.reserved = moving; g_Beacon.pkt.crc = htons(crc16 (g_Beacon.byte, sizeof (g_Beacon) - sizeof (g_Beacon.pkt.crc))); /* transmit packet */ nRF_tx (g_Beacon.pkt.p.tracker.strength); /* powering down */ nRFAPI_PowerDown (); /* add new accelerometer values to lowpass */ fifo = &fifo_buf[fifo_pos]; if(fifo_pos>=(FIFO_DEPTH-1)) fifo_pos=0; else fifo_pos++; acc_lowpass.x += x - fifo->x; fifo->x = x; acc_lowpass.y += y - fifo->y; fifo->y = y; acc_lowpass.z += z - fifo->z; fifo->z = z; if (!firstrun) { if(fifo_pos) { pmu_sleep_ms (500); continue; } else { /* confirm finalized initialization by double-blink */ firstrun = 1; GPIOSetValue (1, 3, 1); pmu_sleep_ms (100); GPIOSetValue (1, 3, 0); pmu_sleep_ms (300); GPIOSetValue (1, 3, 1); pmu_sleep_ms (100); GPIOSetValue (1, 3, 0); } } else if ((abs (acc_lowpass.x/FIFO_DEPTH - x) >= ACC_TRESHOLD) || (abs (acc_lowpass.y/FIFO_DEPTH - y) >= ACC_TRESHOLD) || (abs (acc_lowpass.z/FIFO_DEPTH - z) >= ACC_TRESHOLD)) tamper = 5; if (tamper) { pmu_sleep_ms (750); tamper--; if (moving < ACC_MOVING_TRESHOLD) moving++; else { snd_tone (22); GPIOSetValue (1, 3, 1); pmu_wait_ms (20); GPIOSetValue (1, 3, 0); snd_tone (23); pmu_wait_ms (50); snd_tone (24); pmu_wait_ms (30); snd_tone (0); } } else { pmu_sleep_ms (5000); moving = 0; } } return 0; }