Subversion Repositories NaviCtrl

Rev

Rev 308 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
41 ingob 1
/*#######################################################################################*/
2
/* !!! THIS IS NOT FREE SOFTWARE !!!                                                     */
3
/*#######################################################################################*/
4
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
5
// + Copyright (c) 2008 Ingo Busker, Holger Buss
171 ingob 6
// + Nur für den privaten Gebrauch / NON-COMMERCIAL USE ONLY
41 ingob 7
// + FOR NON COMMERCIAL USE ONLY
8
// + www.MikroKopter.com
9
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
10
// + Es gilt für das gesamte Projekt (Hardware, Software, Binärfiles, Sourcecode und Dokumentation),
11
// + dass eine Nutzung (auch auszugsweise) nur für den privaten (nicht-kommerziellen) Gebrauch zulässig ist.
12
// + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt
13
// + bzgl. der Nutzungsbedingungen aufzunehmen.
14
// + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen,
15
// + Verkauf von Luftbildaufnahmen, usw.
16
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
17
// + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder veröffentlicht,
18
// + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright müssen dann beiliegen
19
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
20
// + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts
21
// + auf anderen Webseiten oder sonstigen Medien veröffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de"
22
// + eindeutig als Ursprung verlinkt werden
23
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
24
// + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion
25
// + Benutzung auf eigene Gefahr
26
// + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden
27
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
171 ingob 28
// + Die Portierung oder Nutzung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur
41 ingob 29
// + mit unserer Zustimmung zulässig
30
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
31
// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen
32
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
33
// + Redistributions of source code (with or without modifications) must retain the above copyright notice,
34
// + this list of conditions and the following disclaimer.
35
// +   * Neither the name of the copyright holders nor the names of contributors may be used to endorse or promote products derived
36
// +     from this software without specific prior written permission.
37
// +   * The use of this project (hardware, software, binary files, sources and documentation) is only permitted
38
// +     for non-commercial use (directly or indirectly)
39
// +     Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted
40
// +     with our written permission
41
// +   * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be
42
// +     clearly linked as origin
171 ingob 43
// +   * porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed
41 ingob 44
//
45
// +  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
46
// +  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
47
// +  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
48
// +  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
49
// +  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
50
// +  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
51
// +  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
52
// +  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
53
// +  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
54
// +  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
55
// +  POSSIBILITY OF SUCH DAMAGE.
56
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
57
//#include <stdio.h>
58
#include "91x_lib.h"
136 killagreg 59
#include "config.h"
41 ingob 60
#include "uart1.h"
190 killagreg 61
#include "mkprotocol.h"
41 ingob 62
 
190 killagreg 63
// the tx buffer
64
#define UART2_TX_BUFFER_LEN  150
65
u8 UART2_tbuffer[UART2_TX_BUFFER_LEN];
66
Buffer_t UART2_tx_buffer;
67
 
41 ingob 68
/********************************************************/
69
/*                  Initialize UART2                    */
70
/********************************************************/
71
void UART2_Init(void)
72
{
73
    UART_InitTypeDef UART_InitStructure;
74
        GPIO_InitTypeDef GPIO_InitStructure;
75
 
110 killagreg 76
        UART1_PutString("\r\n UART2 init...");
41 ingob 77
 
190 killagreg 78
        // initialize txd buffer
79
        Buffer_Init(&UART2_tx_buffer, UART2_tbuffer, UART2_TX_BUFFER_LEN);
80
 
41 ingob 81
        SCU_APBPeriphClockConfig(__UART2, ENABLE);  // Enable the UART2 Clock
82
 
83
        SCU_APBPeriphClockConfig(__GPIO5, ENABLE);  // Enable the GPIO5 Clock
84
    /*Configure UART2_Rx pin GPIO5.2*/
85
        GPIO_StructInit(&GPIO_InitStructure);
86
        GPIO_InitStructure.GPIO_Direction =     GPIO_PinInput;
87
    GPIO_InitStructure.GPIO_Pin =                       GPIO_Pin_2;
88
    GPIO_InitStructure.GPIO_Type =                      GPIO_Type_PushPull;
196 killagreg 89
    GPIO_InitStructure.GPIO_IPInputConnected =  GPIO_IPInputConnected_Enable;
41 ingob 90
    GPIO_InitStructure.GPIO_Alternate =         GPIO_InputAlt1; // UART2_RxD
91
    GPIO_Init(GPIO5, &GPIO_InitStructure);
92
 
93
        SCU_APBPeriphClockConfig(__GPIO3, ENABLE);  // Enable the GPIO3 Clock
94
    /*Configure UART2_Tx pin GPIO3.0*/
95
        GPIO_StructInit(&GPIO_InitStructure);
96
        GPIO_InitStructure.GPIO_Direction =     GPIO_PinOutput;
97
    GPIO_InitStructure.GPIO_Pin =                       GPIO_Pin_0;
98
    GPIO_InitStructure.GPIO_Type =                      GPIO_Type_PushPull;
99
    GPIO_InitStructure.GPIO_Alternate =         GPIO_OutputAlt2; // UART2_TX
100
    GPIO_Init(GPIO3, &GPIO_InitStructure);
101
 
102
 
103
        /* UART2 configured as follow:
104
          - Word Length = 8 Bits
105
          - One Stop Bit
106
          - No parity
107
          - BaudRate = 57600 baud
108
          - Hardware flow control Disabled
109
          - Receive and transmit enabled
110
          - Receive and transmit FIFOs are Disabled
111
    */
112
        UART_StructInit(&UART_InitStructure);
113
    UART_InitStructure.UART_WordLength =                        UART_WordLength_8D;
114
    UART_InitStructure.UART_StopBits =                          UART_StopBits_1;
115
    UART_InitStructure.UART_Parity =                            UART_Parity_No ;
110 killagreg 116
    UART_InitStructure.UART_BaudRate =                          UART2_BAUD_RATE;
41 ingob 117
    UART_InitStructure.UART_HardwareFlowControl =       UART_HardwareFlowControl_None;
118
    UART_InitStructure.UART_Mode =                                      UART_Mode_Tx_Rx;
119
    UART_InitStructure.UART_FIFO =                                      UART_FIFO_Enable;
120
    UART_InitStructure.UART_TxFIFOLevel =                       UART_FIFOLevel_1_2;
139 killagreg 121
    UART_InitStructure.UART_RxFIFOLevel =                       UART_FIFOLevel_1_2;
41 ingob 122
 
123
        UART_DeInit(UART2);     // reset uart 2 to default
124
    UART_Init(UART2, &UART_InitStructure);  // initialize uart 2
125
 
126
        // enable uart 2 interrupts selective
127
    UART_ITConfig(UART2, UART_IT_Receive | UART_IT_ReceiveTimeOut, ENABLE);
128
        UART_Cmd(UART2, ENABLE); // enable uart 2
136 killagreg 129
        // configure the uart 2 interupt line
130
        VIC_Config(UART2_ITLine, VIC_IRQ, PRIORITY_UART2);
41 ingob 131
        // enable the uart 2 IRQ
132
        VIC_ITCmd(UART2_ITLine, ENABLE);
133
 
110 killagreg 134
        UART1_PutString("ok");
41 ingob 135
}
136
 
137
 
138
void UART2_Deinit(void)
139
{
140
        GPIO_InitTypeDef GPIO_InitStructure;
141
 
110 killagreg 142
        UART1_PutString("\r\n UART2 deinit...");
41 ingob 143
        VIC_ITCmd(UART2_ITLine, DISABLE); // disable the uart 2 IRQ
144
        UART_Cmd(UART2, DISABLE); // disable uart 2
145
        UART_DeInit(UART2);     // reset uart 0 to default
146
 
147
        SCU_APBPeriphClockConfig(__UART2, DISABLE);  // disable the UART2 Clock
148
 
149
        SCU_APBPeriphClockConfig(__GPIO5, ENABLE);
150
        // unmap UART2 from FC
151
        // set port pin 5.2 (serial data from FC) to input and disconnect from IP
152
        GPIO_StructInit(&GPIO_InitStructure);
153
        GPIO_InitStructure.GPIO_Direction =     GPIO_PinInput;
154
    GPIO_InitStructure.GPIO_Pin =                       GPIO_Pin_2;
155
    GPIO_InitStructure.GPIO_Type =                      GPIO_Type_PushPull;
196 killagreg 156
    GPIO_InitStructure.GPIO_IPInputConnected =  GPIO_IPInputConnected_Disable;
41 ingob 157
    GPIO_InitStructure.GPIO_Alternate =         GPIO_InputAlt1;
158
    GPIO_Init(GPIO5, &GPIO_InitStructure);
159
 
160
        SCU_APBPeriphClockConfig(__GPIO3, ENABLE);
161
        // set port pin 3.0 (serial data to FC) to input and disconnect from IP
162
        GPIO_StructInit(&GPIO_InitStructure);
163
        GPIO_InitStructure.GPIO_Direction =     GPIO_PinInput;
164
    GPIO_InitStructure.GPIO_Pin =                       GPIO_Pin_0;
165
    GPIO_InitStructure.GPIO_Type =                      GPIO_Type_PushPull;
196 killagreg 166
        GPIO_InitStructure.GPIO_IPInputConnected =      GPIO_IPInputConnected_Disable;
41 ingob 167
    GPIO_InitStructure.GPIO_Alternate =         GPIO_InputAlt1;
168
    GPIO_Init(GPIO3, &GPIO_InitStructure);
169
 
110 killagreg 170
        UART1_PutString("ok");
41 ingob 171
}
172
 
173
/********************************************************/
174
/*            UART2 Interrupt Handler                   */
175
/********************************************************/
176
void UART2_IRQHandler(void)
177
{
195 killagreg 178
        IENABLE;       
179
 
41 ingob 180
        // if receive irq or receive timeout irq has occured
181
        if((UART_GetITStatus(UART2, UART_IT_Receive) != RESET) || (UART_GetITStatus(UART2, UART_IT_ReceiveTimeOut) != RESET) )
182
        {
183
                UART_ClearITPendingBit(UART2, UART_IT_Receive);                 // clear receive interrupt flag
184
                UART_ClearITPendingBit(UART2, UART_IT_ReceiveTimeOut);  // clear receive timeout interrupt flag
185
 
186
                // if debug UART is UART2
187
                if (DebugUART == UART2)
188
                {       // forward received data to the UART1 tx buffer
189
                        while(UART_GetFlagStatus(UART2, UART_FLAG_RxFIFOEmpty) != SET)
190
                        {
191
                                // wait for space in the tx buffer of the UART1
192
                                while(UART_GetFlagStatus(UART1, UART_FLAG_TxFIFOFull) == SET) {};
193
                                // move the byte from the rx buffer of UART2 to the tx buffer of UART1
194
                                UART_SendData(UART1, UART_ReceiveData(UART2));
195
                        }
196
                }
197
                else
198
                {
199
                        // ignore serial data from the FC
200
                        while(UART_GetFlagStatus(UART2, UART_FLAG_RxFIFOEmpty) != SET)
190 killagreg 201
                        {
202
                                UART_ReceiveData(UART2);
203
                        }
41 ingob 204
                }
205
        } // eof receive irq or receive timeout irq
195 killagreg 206
 
207
        IDISABLE;
41 ingob 208
}
190 killagreg 209
 
210
/**************************************************************/
211
/*         Transmit tx buffer via uart2                       */
212
/**************************************************************/
213
void UART2_Transmit(void)
214
{
215
        u8 tmp_tx;
216
        if(DebugUART == UART2) return; // no data output if debug uart is rederected to UART2
217
        // if something has to be send and the txd fifo is not full
218
        if((UART2_tx_buffer.Locked == TRUE) && (UART_GetFlagStatus(UART2, UART_FLAG_TxFIFOFull) == RESET))
219
        {
220
                tmp_tx = UART2_tx_buffer.pData[UART2_tx_buffer.Position++]; // read next byte from txd buffer
221
                UART_SendData(UART2, tmp_tx); // put character to txd fifo
222
                // if terminating character or end of txd buffer reached
223
                if((tmp_tx == '\r') || (UART2_tx_buffer.Position == UART2_tx_buffer.Size))
224
                {
225
                        Buffer_Clear(&UART2_tx_buffer);
226
                }
227
        }
228
}
229
 
230
/**************************************************************/
231
/* Send the answers to incomming commands at the uart2        */
232
/**************************************************************/
233
void UART2_TransmitTxData(void)
234
{
235
        if(DebugUART == UART2) return;
236
        UART2_Transmit(); // output pending bytes in tx buffer
237
}
238
 
239
 
240
void UART2_ProcessRxData(void)
241
{
242
 
243
}