Subversion Repositories NaviCtrl

Rev

Rev 110 | Rev 112 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 110 Rev 111
1
/*#######################################################################################*/
1
/*#######################################################################################*/
2
/* !!! THIS IS NOT FREE SOFTWARE !!!                                                     */
2
/* !!! THIS IS NOT FREE SOFTWARE !!!                                                     */
3
/*#######################################################################################*/
3
/*#######################################################################################*/
4
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
4
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
5
// + Copyright (c) 2008 Ingo Busker, Holger Buss
5
// + Copyright (c) 2008 Ingo Busker, Holger Buss
6
// + Nur für den privaten Gebrauch
6
// + Nur für den privaten Gebrauch
7
// + FOR NON COMMERCIAL USE ONLY
7
// + FOR NON COMMERCIAL USE ONLY
8
// + www.MikroKopter.com
8
// + www.MikroKopter.com
9
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
9
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
10
// + Es gilt für das gesamte Projekt (Hardware, Software, Binärfiles, Sourcecode und Dokumentation), 
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. 
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 
12
// + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt 
13
// + bzgl. der Nutzungsbedingungen aufzunehmen. 
13
// + bzgl. der Nutzungsbedingungen aufzunehmen. 
14
// + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen,
14
// + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen,
15
// + Verkauf von Luftbildaufnahmen, usw.
15
// + Verkauf von Luftbildaufnahmen, usw.
16
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
16
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
17
// + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder veröffentlicht, 
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
18
// + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright müssen dann beiliegen
19
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
19
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
20
// + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts
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"
21
// + auf anderen Webseiten oder sonstigen Medien veröffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de"
22
// + eindeutig als Ursprung verlinkt werden
22
// + eindeutig als Ursprung verlinkt werden
23
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
23
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
24
// + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion
24
// + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion
25
// + Benutzung auf eigene Gefahr
25
// + Benutzung auf eigene Gefahr
26
// + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden
26
// + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden
27
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
27
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
28
// + Die PORTIERUNG der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur 
28
// + Die PORTIERUNG der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur 
29
// + mit unserer Zustimmung zulässig
29
// + mit unserer Zustimmung zulässig
30
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
30
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
31
// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen
31
// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen
32
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
32
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
33
// + Redistributions of source code (with or without modifications) must retain the above copyright notice, 
33
// + Redistributions of source code (with or without modifications) must retain the above copyright notice, 
34
// + this list of conditions and the following disclaimer.
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
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.
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 
37
// +   * The use of this project (hardware, software, binary files, sources and documentation) is only permitted 
38
// +     for non-commercial use (directly or indirectly)
38
// +     for non-commercial use (directly or indirectly)
39
// +     Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted 
39
// +     Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted 
40
// +     with our written permission
40
// +     with our written permission
41
// +   * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be 
41
// +   * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be 
42
// +     clearly linked as origin 
42
// +     clearly linked as origin 
43
// +   * PORTING this software (or part of it) to systems (other than hardware from www.mikrokopter.de) is NOT allowed
43
// +   * PORTING this software (or part of it) to systems (other than hardware from www.mikrokopter.de) is NOT allowed
44
//
44
//
45
// +  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
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
46
// +  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
47
// +  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
47
// +  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
48
// +  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
48
// +  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
49
// +  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
49
// +  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
50
// +  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
50
// +  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
51
// +  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
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
52
// +  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
53
// +  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
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
54
// +  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
55
// +  POSSIBILITY OF SUCH DAMAGE. 
55
// +  POSSIBILITY OF SUCH DAMAGE. 
56
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
56
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
57
#include "91x_lib.h"
57
#include "91x_lib.h"
58
#include "uart1.h"
58
#include "uart1.h"
59
#include "usb.h"
59
#include "usb.h"
-
 
60
#include "mkprotocol.h"
-
 
61
 
-
 
62
 
-
 
63
// the tx buffer
-
 
64
#define USB_TX_BUFFER_LEN  150
-
 
65
u8 USB_tbuffer[USB_TX_BUFFER_LEN];
-
 
66
Buffer_t USB_tx_buffer;
-
 
67
 
-
 
68
// the rx buffer
-
 
69
#define USB_RX_BUFFER_LEN  150
-
 
70
u8 USB_rbuffer[USB_RX_BUFFER_LEN];
-
 
71
Buffer_t USB_rx_buffer;
-
 
72
 
-
 
73
 
60
//-----------------------------------------------------------------
74
//-----------------------------------------------------------------
61
void USB_ConfigInit(void)
75
void USB_ConfigInit(void)
62
{
76
{
63
        GPIO_InitTypeDef GPIO_InitStructure;
77
        GPIO_InitTypeDef GPIO_InitStructure;
64
 
78
 
65
        UART1_PutString("\r\n USB init...");
79
        UART1_PutString("\r\n USB init...");
66
        #ifdef MCLK96MHZ
80
        #ifdef MCLK96MHZ
67
        //USB clock = MCLK/2 = 48MHz
81
        //USB clock = MCLK/2 = 48MHz
68
        SCU_USBCLKConfig(SCU_USBCLK_MCLK2);
82
        SCU_USBCLKConfig(SCU_USBCLK_MCLK2);
69
        #else
83
        #else
70
        //USB clock = MCLK = 48MHz
84
        //USB clock = MCLK = 48MHz
71
        SCU_USBCLKConfig(SCU_USBCLK_MCLK);
85
        SCU_USBCLKConfig(SCU_USBCLK_MCLK);
72
        #endif
86
        #endif
73
        //Enable USB clock
87
        //Enable USB clock
74
        SCU_AHBPeriphClockConfig(__USB,ENABLE);
88
        SCU_AHBPeriphClockConfig(__USB,ENABLE);
75
        SCU_AHBPeriphReset(__USB,DISABLE);
89
        SCU_AHBPeriphReset(__USB,DISABLE);
76
        SCU_AHBPeriphClockConfig(__USB48M,ENABLE);
90
        SCU_AHBPeriphClockConfig(__USB48M,ENABLE);
77
 
91
 
78
        //Configure GPIO0 (D+ Pull-Up on P0.1)
92
        //Configure GPIO0 (D+ Pull-Up on P0.1)
79
        SCU_APBPeriphClockConfig(__GPIO0 ,ENABLE);
93
        SCU_APBPeriphClockConfig(__GPIO0 ,ENABLE);
80
        SCU_APBPeriphReset(__GPIO0,DISABLE);
94
        SCU_APBPeriphReset(__GPIO0,DISABLE);
81
 
95
 
82
        // GPIO_DeInit(P0.1);
96
        // GPIO_DeInit(P0.1);
83
        GPIO_StructInit(&GPIO_InitStructure);
97
        GPIO_StructInit(&GPIO_InitStructure);
84
        GPIO_InitStructure.GPIO_Direction = GPIO_PinOutput;
98
        GPIO_InitStructure.GPIO_Direction = GPIO_PinOutput;
85
        GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1;
99
        GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1;
86
        GPIO_InitStructure.GPIO_Type = GPIO_Type_PushPull ;
100
        GPIO_InitStructure.GPIO_Type = GPIO_Type_PushPull ;
87
        GPIO_InitStructure.GPIO_IPConnected=GPIO_IPConnected_Enable;
101
        GPIO_InitStructure.GPIO_IPConnected=GPIO_IPConnected_Enable;
88
        GPIO_InitStructure.GPIO_Alternate=GPIO_OutputAlt1;
102
        GPIO_InitStructure.GPIO_Alternate=GPIO_OutputAlt1;
89
        GPIO_Init (GPIO0, &GPIO_InitStructure);
103
        GPIO_Init (GPIO0, &GPIO_InitStructure);
-
 
104
 
-
 
105
                // initialize txd buffer
-
 
106
        USB_tx_buffer.pData = USB_tbuffer;
-
 
107
        USB_tx_buffer.Size = USB_TX_BUFFER_LEN;
-
 
108
        USB_tx_buffer.Position = 0;
-
 
109
        USB_tx_buffer.Locked = FALSE;
-
 
110
       
-
 
111
        // initialize rxd buffer
-
 
112
        USB_rx_buffer.pData = USB_rbuffer;
-
 
113
        USB_rx_buffer.Size = USB_RX_BUFFER_LEN;
-
 
114
        USB_rx_buffer.Position = 0;
-
 
115
        USB_rx_buffer.Locked = FALSE;
-
 
116
 
90
 
117
 
91
        PowerOff();
118
        PowerOff();
92
        Virtual_Com_Port_Reset();
119
        Virtual_Com_Port_Reset();
93
 
120
 
94
        VIC_Config(USBLP_ITLine, VIC_IRQ, 2);
121
        VIC_Config(USBLP_ITLine, VIC_IRQ, 2);
95
        VIC_ITCmd(USBLP_ITLine, ENABLE);
122
        VIC_ITCmd(USBLP_ITLine, ENABLE);
96
 
123
 
97
        USB_Init();
124
        USB_Init();
98
 
125
 
99
        UART1_PutString("ok");  
126
        UART1_PutString("ok");  
100
}
127
}
101
 
128
 
102
//-----------------------------------------------------------------
129
//-----------------------------------------------------------------
103
void USB_Cable_Config (FunctionalState NewState)
130
void USB_CableConfig(FunctionalState NewState)
104
{
131
{
105
        if (NewState == ENABLE)
132
        if (NewState == ENABLE)
106
        GPIO_WriteBit(GPIO0, GPIO_Pin_1, Bit_RESET);
133
        GPIO_WriteBit(GPIO0, GPIO_Pin_1, Bit_RESET);
107
        else
134
        else
108
        GPIO_WriteBit(GPIO0, GPIO_Pin_1, Bit_SET);
135
        GPIO_WriteBit(GPIO0, GPIO_Pin_1, Bit_SET);
109
}
136
}
110
 
137
 
111
//-----------------------------------------------------------------
138
//-----------------------------------------------------------------
112
void USB_Send_String(u8 *StrPtr)
139
void USB_PutString(u8 *string)
113
{
140
{
114
        u8 i = 0;
141
        u8 i = 0;
115
        u16 timeout = 0;
142
        u16 timeout = 0;
116
       
143
       
117
        while (StrPtr[i++] !=0){} // get string len
144
        while (string[i++] != 0){} // get string len
118
        while (_GetEPTxStatus(ENDP1) != EP_TX_NAK){ if (timeout++ > 60000) return;}
145
        while (_GetEPTxStatus(ENDP1) != EP_TX_NAK){ if (timeout++ > 60000) return;}
119
        UserToPMABufferCopy(StrPtr, ENDP1_TXADDR, ++i); // copy string to usb buffer
146
        UserToPMABufferCopy(string, ENDP1_TXADDR, ++i); // copy string to usb buffer
120
        SetEPTxCount(ENDP1,i);
147
        SetEPTxCount(ENDP1,i);
121
        SetEPTxValid(ENDP1);
148
        SetEPTxValid(ENDP1);
122
}
149
}
123
 
150
 
124
//-----------------------------------------------------------------
151
//-----------------------------------------------------------------
125
void USB_Send_Char(u8 ch)
152
void USB_PutChar(u8 c)
126
{
153
{
127
        u16 timeout = 0;
154
        u16 timeout = 0;
128
        while (_GetEPTxStatus(ENDP1) != EP_TX_NAK){ if (timeout++ > 60000) return;}
155
        while (_GetEPTxStatus(ENDP1) != EP_TX_NAK){ if (timeout++ > 60000) return;}
129
        UserToPMABufferCopy(&ch, ENDP1_TXADDR, 2);
156
        UserToPMABufferCopy(&c, ENDP1_TXADDR, 2);
130
        SetEPTxCount(ENDP1,2);
157
        SetEPTxCount(ENDP1,2);
131
        SetEPTxValid(ENDP1);
158
        SetEPTxValid(ENDP1);
132
}
159
}
133
 
160
 
134
//-----------------------------------------------------------------
161
//-----------------------------------------------------------------
135
void USB_Send_Data(u8 *data, u16 count)
162
void USB_SendData(u8 *pdata, u16 count)
136
{
163
{
137
        u8 i;
164
        u8 i;
138
        count++;
165
        count++;
139
       
166
       
140
        for (i=0;i< (count/64)+1;i++)  
167
        for (i=0;i< (count/64)+1;i++)  
141
        {
168
        {
142
                while (_GetEPTxStatus(ENDP1) != EP_TX_NAK);
169
                while (_GetEPTxStatus(ENDP1) != EP_TX_NAK);
143
                if (i < (count/64))
170
                if (i < (count/64))
144
                {
171
                {
145
                        UserToPMABufferCopy(&data[i*64], ENDP1_TXADDR, 64);
172
                        UserToPMABufferCopy(&pdata[i*64], ENDP1_TXADDR, 64);
146
                        SetEPTxCount(ENDP1,64);
173
                        SetEPTxCount(ENDP1,64);
147
                }
174
                }
148
                else
175
                else
149
                {
176
                {
150
                        UserToPMABufferCopy(&data[i*64], ENDP1_TXADDR, count % 64);
177
                        UserToPMABufferCopy(&pdata[i*64], ENDP1_TXADDR, count % 64);
151
                        SetEPTxCount(ENDP1, count % 64);
178
                        SetEPTxCount(ENDP1, count % 64);
152
                }
179
                }
153
               
-
 
154
                SetEPTxValid(ENDP1);
180
                SetEPTxValid(ENDP1);
155
        }
181
        }
156
}
182
}
157
 
183
 
158
 
184