void telemetryTransmitBuffer(uint8_t * buffer, uint32_t size) { txPdcUsart(buffer, size); }
// the loop function runs over and over again forever void checkM64() { uint8_t count ; // int16_t byte ; poll_mega64() ; if ( M64SetContrast ) { if ( TxBusy == 0 ) { uint8_t buf[2] ; buf[0] = M64Contrast ; buf[1] = 50 ; // Brightness - unused count = fillTxBuffer( buf, 0x13, 2 ) ; txPdcUsart( TxBuffer, count ) ; M64SetContrast = 0 ; } } if ( SendDisplay ) { if ( TxBusy == 0 ) { count = fillTxBuffer( M64Display, 0, 64 ) ; DisplaySequence = 0x81 ; txPdcUsart( TxBuffer, count ) ; SendDisplay = 0 ; } } // if ( ReadingEeprom == 1 ) // { // if ( StartDelay ) // { // if ( EepromAddress < 4096 ) // { // if ( TxBusy == 0 ) // { // uint8_t temp[2] ; // temp[0] = EepromAddress ; // temp[0] = EepromAddress >> 8 ; // // 0x01, 0x12, 16 bit address, 0x01 - send 32 bytes EEPROM data @ address // count = fillTxBuffer( temp, 0x12, 2 ) ; // ReadingEeprom = 2 ; // txPdcUsart( TxBuffer, count ) ; // } // } // else // { // ReadingEeprom = 0 ; // Done // } // } // } if ( DisplaySequence ) { if ( TxBusy == 0 ) { count = fillTxBuffer( &M64Display[64*(DisplaySequence & 0x0F)], DisplaySequence & 0x0F, 64 ) ; txPdcUsart( TxBuffer, count ) ; DisplaySequence += 1 ; if ( DisplaySequence > 0x8F) { DisplaySequence = 0 ; if ( ResendDisplay ) { memcpy( M64Display, DisplayBuf, sizeof(M64Display) ) ; ResendDisplay = 0 ; SendDisplay = 1 ; } } } } // while ( ( byte = get_fifo64( &mega64_fifo ) ) != -1 ) // { // processSlaveByte( byte ) ; // if (SlaveActionRequired) // { // SlaveActionRequired = 0 ; // if ( SlaveType == 0x80 ) // { // byte = SlaveTempReceiveBuffer[0] ; // Buttons = byte & 0x7E ; // Trims = SlaveTempReceiveBuffer[1] ; // Switches = SlaveTempReceiveBuffer[2] | ( ( byte & 1 ) << 8 ) ; // Analog[0] = SlaveTempReceiveBuffer[3] | ( SlaveTempReceiveBuffer[4] << 8 ) ; // Analog[1] = SlaveTempReceiveBuffer[5] | ( SlaveTempReceiveBuffer[6] << 8 ) ; // Analog[2] = SlaveTempReceiveBuffer[7] | ( SlaveTempReceiveBuffer[8] << 8 ) ; // Analog[3] = SlaveTempReceiveBuffer[9] | ( SlaveTempReceiveBuffer[10] << 8 ) ; // Analog[4] = SlaveTempReceiveBuffer[11] | ( SlaveTempReceiveBuffer[12] << 8 ) ; // Analog[5] = SlaveTempReceiveBuffer[13] | ( SlaveTempReceiveBuffer[14] << 8 ) ; // Analog[6] = SlaveTempReceiveBuffer[15] | ( SlaveTempReceiveBuffer[16] << 8 ) ; // Analog[7] = SlaveTempReceiveBuffer[17] | ( SlaveTempReceiveBuffer[18] << 8 ) ; // } // else if ( SlaveType == 0x81 ) // EEPROM data // { // uint16_t address ; // uint32_t i ; // address = SlaveTempReceiveBuffer[0] | ( SlaveTempReceiveBuffer[1] << 8 ) ; // for ( i = 2 ; i < 34 ; i += 1 ) // { // EepromImage[address++] = SlaveTempReceiveBuffer[i] ; // } // EepromAddress += 32 ; // ReadingEeprom = 1 ; // } // } // } // wdt_reset() ; }