For robots and stuff
CC1101/CC1101-Threads.cpp@1:05a48c038381, 2014-12-28 (annotated)
- Committer:
- jjones646
- Date:
- Sun Dec 28 06:28:42 2014 +0000
- Revision:
- 1:05a48c038381
- Parent:
- Wireless/CC1101/CC1101-Threads.cpp@0:c5afea7b9057
- Child:
- 2:c42a035d71ed
updating;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
jjones646 | 0:c5afea7b9057 | 1 | #include "Radio.h" |
jjones646 | 0:c5afea7b9057 | 2 | |
jjones646 | 0:c5afea7b9057 | 3 | |
jjones646 | 0:c5afea7b9057 | 4 | /* |
jjones646 | 0:c5afea7b9057 | 5 | |
jjones646 | 0:c5afea7b9057 | 6 | // SERIAL THREAD |
jjones646 | 0:c5afea7b9057 | 7 | void CC1101::get_serial_data_thread(void const *arg) |
jjones646 | 0:c5afea7b9057 | 8 | { |
jjones646 | 0:c5afea7b9057 | 9 | CC1101 *instance = (CC1101*)arg; |
jjones646 | 0:c5afea7b9057 | 10 | osSignalWait(START_THREAD, osWaitForever); |
jjones646 | 0:c5afea7b9057 | 11 | Timer t; |
jjones646 | 0:c5afea7b9057 | 12 | |
jjones646 | 0:c5afea7b9057 | 13 | while(1) { |
jjones646 | 0:c5afea7b9057 | 14 | |
jjones646 | 0:c5afea7b9057 | 15 | if (instance->_pc.readable()) { |
jjones646 | 0:c5afea7b9057 | 16 | |
jjones646 | 0:c5afea7b9057 | 17 | if (t.read_us()) { |
jjones646 | 0:c5afea7b9057 | 18 | t.reset(); |
jjones646 | 0:c5afea7b9057 | 19 | } else { |
jjones646 | 0:c5afea7b9057 | 20 | t.start(); |
jjones646 | 0:c5afea7b9057 | 21 | } |
jjones646 | 0:c5afea7b9057 | 22 | |
jjones646 | 0:c5afea7b9057 | 23 | instance->_rx_int->disable_irq(); |
jjones646 | 0:c5afea7b9057 | 24 | instance->rxBuf.putc(instance->_pc.getc()); |
jjones646 | 0:c5afea7b9057 | 25 | instance->_rx_int->enable_irq(); |
jjones646 | 0:c5afea7b9057 | 26 | } |
jjones646 | 0:c5afea7b9057 | 27 | |
jjones646 | 0:c5afea7b9057 | 28 | if ( (instance->rxBuf.use() > 20) | (t.read_ms() > 50)) { // if more than 20 bytes received then tx the packet in RF |
jjones646 | 0:c5afea7b9057 | 29 | // set the signal for sending data |
jjones646 | 0:c5afea7b9057 | 30 | instance->_transmit_thread.signal_set(NEW_DATA); |
jjones646 | 0:c5afea7b9057 | 31 | t.stop(); |
jjones646 | 0:c5afea7b9057 | 32 | t.reset(); |
jjones646 | 0:c5afea7b9057 | 33 | } |
jjones646 | 0:c5afea7b9057 | 34 | |
jjones646 | 0:c5afea7b9057 | 35 | Thread::wait(50); |
jjones646 | 0:c5afea7b9057 | 36 | |
jjones646 | 0:c5afea7b9057 | 37 | } |
jjones646 | 0:c5afea7b9057 | 38 | } |
jjones646 | 0:c5afea7b9057 | 39 | |
jjones646 | 0:c5afea7b9057 | 40 | */ |
jjones646 | 0:c5afea7b9057 | 41 | |
jjones646 | 0:c5afea7b9057 | 42 | // TRANSMITTING THREAD |
jjones646 | 0:c5afea7b9057 | 43 | void Radio::transmit_thread(void const *arg) |
jjones646 | 0:c5afea7b9057 | 44 | { |
jjones646 | 0:c5afea7b9057 | 45 | Radio *instance = (Radio*)arg; |
jjones646 | 0:c5afea7b9057 | 46 | osSignalWait(START_THREAD, osWaitForever); |
jjones646 | 0:c5afea7b9057 | 47 | |
jjones646 | 0:c5afea7b9057 | 48 | while(1) { |
jjones646 | 0:c5afea7b9057 | 49 | osEvent evt = instance->_tx_data.get(); |
jjones646 | 0:c5afea7b9057 | 50 | if (evt.status == osEventMail) { |
jjones646 | 0:c5afea7b9057 | 51 | RTP_t *mail = (RTP_t*)evt.value.p; |
jjones646 | 0:c5afea7b9057 | 52 | |
jjones646 | 0:c5afea7b9057 | 53 | instance->put_pck(mail->payload, mail->size); // send the packet over air |
jjones646 | 0:c5afea7b9057 | 54 | } |
jjones646 | 0:c5afea7b9057 | 55 | } |
jjones646 | 0:c5afea7b9057 | 56 | } |
jjones646 | 0:c5afea7b9057 | 57 | |
jjones646 | 0:c5afea7b9057 | 58 | |
jjones646 | 0:c5afea7b9057 | 59 | // RECEIVING THREAD |
jjones646 | 0:c5afea7b9057 | 60 | void Radio::receive_thread(void const *arg) |
jjones646 | 0:c5afea7b9057 | 61 | { |
jjones646 | 0:c5afea7b9057 | 62 | Radio *instance = (Radio*)arg; |
jjones646 | 0:c5afea7b9057 | 63 | osSignalWait(START_THREAD, osWaitForever); |
jjones646 | 0:c5afea7b9057 | 64 | |
jjones646 | 0:c5afea7b9057 | 65 | // receiving operations |
jjones646 | 0:c5afea7b9057 | 66 | while(1) { |
jjones646 | 0:c5afea7b9057 | 67 | osSignalWait(NEW_DATA, osWaitForever); |
jjones646 | 0:c5afea7b9057 | 68 | |
jjones646 | 0:c5afea7b9057 | 69 | // set the limit for max bytes to put in the buffer every time |
jjones646 | 0:c5afea7b9057 | 70 | uint8_t rxlength = BUFFER_SIZE; |
jjones646 | 0:c5afea7b9057 | 71 | |
jjones646 | 0:c5afea7b9057 | 72 | instance->_spi->frequency(8500000); |
jjones646 | 0:c5afea7b9057 | 73 | if (instance->get_pck(instance->buffer, &rxlength) ) { |
jjones646 | 0:c5afea7b9057 | 74 | |
jjones646 | 0:c5afea7b9057 | 75 | if (instance->buffer[0] == 0x02) { |
jjones646 | 0:c5afea7b9057 | 76 | instance->_need_ack = false; |
jjones646 | 0:c5afea7b9057 | 77 | } else { |
jjones646 | 0:c5afea7b9057 | 78 | |
jjones646 | 0:c5afea7b9057 | 79 | RTP_t *data = instance->_rx_data.alloc(); |
jjones646 | 0:c5afea7b9057 | 80 | data->payload = instance->buffer; |
jjones646 | 0:c5afea7b9057 | 81 | instance->_rx_data.put(data); |
jjones646 | 0:c5afea7b9057 | 82 | |
jjones646 | 0:c5afea7b9057 | 83 | // send the data over the serial connection |
jjones646 | 0:c5afea7b9057 | 84 | #if DEBUG_MODE > 0 |
jjones646 | 0:c5afea7b9057 | 85 | std::printf(" ==============\r\n"); |
jjones646 | 0:c5afea7b9057 | 86 | for (int i=0; i < rxlength; i++) { |
jjones646 | 0:c5afea7b9057 | 87 | std::printf(" | 0x%02X |\r\n", instance->buffer[i]); |
jjones646 | 0:c5afea7b9057 | 88 | } |
jjones646 | 0:c5afea7b9057 | 89 | std::printf(" ==============\r\n"); |
jjones646 | 0:c5afea7b9057 | 90 | #endif |
jjones646 | 0:c5afea7b9057 | 91 | |
jjones646 | 0:c5afea7b9057 | 92 | } |
jjones646 | 0:c5afea7b9057 | 93 | } else { |
jjones646 | 0:c5afea7b9057 | 94 | std::printf("Receiving packet failure\r\n"); |
jjones646 | 0:c5afea7b9057 | 95 | } |
jjones646 | 0:c5afea7b9057 | 96 | instance->_spi->frequency(5000000); |
jjones646 | 0:c5afea7b9057 | 97 | } |
jjones646 | 0:c5afea7b9057 | 98 | } |