Subversion Repositories NaviCtrl

/*#######################################################################################*/

/* !!! THIS IS NOT FREE SOFTWARE !!!                                                     */

/*#######################################################################################*/

// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// + Copyright (c) 2008 Ingo Busker, Holger Buss

// + Nur für den privaten Gebrauch / NON-COMMERCIAL USE ONLY

// + FOR NON COMMERCIAL USE ONLY

// + www.MikroKopter.com

// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// + Es gilt für das gesamte Projekt (Hardware, Software, Binärfiles, Sourcecode und Dokumentation), 

// + dass eine Nutzung (auch auszugsweise) nur für den privaten (nicht-kommerziellen) Gebrauch zulässig ist. 

// + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt 

// + bzgl. der Nutzungsbedingungen aufzunehmen. 

// + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen,

// + Verkauf von Luftbildaufnahmen, usw.

// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder veröffentlicht, 

// + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright müssen dann beiliegen

// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts

// + auf anderen Webseiten oder sonstigen Medien veröffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de"

// + eindeutig als Ursprung verlinkt werden

// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion

// + Benutzung auf eigene Gefahr

// + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden

// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// + Die Portierung oder Nutzung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur 

// + mit unserer Zustimmung zulässig

// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen

// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

// + Redistributions of source code (with or without modifications) must retain the above copyright notice, 

// + this list of conditions and the following disclaimer.

// +   * Neither the name of the copyright holders nor the names of contributors may be used to endorse or promote products derived

// +     from this software without specific prior written permission.

// +   * The use of this project (hardware, software, binary files, sources and documentation) is only permitted 

// +     for non-commercial use (directly or indirectly)

// +     Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted 

// +     with our written permission

// +   * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be 

// +     clearly linked as origin 

// +   * porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed

//

// +  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"

// +  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE

// +  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE

// +  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE

// +  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR

// +  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF

// +  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS

// +  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN

// +  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)

// +  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE

// +  POSSIBILITY OF SUCH DAMAGE. 

// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

#include "main.h"

//-----------------------------------------------------------------

void USB_ConfigInit(void)

{

  GPIO_InitTypeDef GPIO_InitStructure;

   SerialPutString("USB init...");

   //USB clock = MCLK= 48MHz

   SCU_USBCLKConfig(SCU_USBCLK_MCLK);

   //Enable USB clock

   SCU_AHBPeriphClockConfig(__USB,ENABLE);

   SCU_AHBPeriphReset(__USB,DISABLE);

   SCU_AHBPeriphClockConfig(__USB48M,ENABLE);

 //Configure GPIO0 (D+ Pull-Up on P0.1)

  SCU_APBPeriphClockConfig(__GPIO0 ,ENABLE);

  SCU_APBPeriphReset(__GPIO0,DISABLE);

 // GPIO_DeInit(GPIO0);

  GPIO_InitStructure.GPIO_Direction = GPIO_PinOutput;

  GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1;

  GPIO_InitStructure.GPIO_Type = GPIO_Type_PushPull ;

  GPIO_InitStructure.GPIO_IPConnected=GPIO_IPConnected_Enable;

  GPIO_InitStructure.GPIO_Alternate=GPIO_OutputAlt1;

  GPIO_Init (GPIO0, &GPIO_InitStructure);

  PowerOff();

  Virtual_Com_Port_Reset();

  VIC_Config(USBLP_ITLine, VIC_IRQ, 2);

  VIC_ITCmd(USBLP_ITLine, ENABLE);

  USB_Init();

  SerialPutString("ok\n\r");

}

//-----------------------------------------------------------------

void USB_Cable_Config (FunctionalState NewState)

{

     if (NewState == ENABLE)

     GPIO_WriteBit(GPIO0, GPIO_Pin_1, Bit_RESET);

     else

     GPIO_WriteBit(GPIO0, GPIO_Pin_1, Bit_SET);

}

//-----------------------------------------------------------------

void USB_Send_String(u8 *StrPtr)

{

u8 i = 0;

u16 timeout = 0;

while (StrPtr[i++] !=0){}

while (_GetEPTxStatus(ENDP1) != EP_TX_NAK){ if (timeout++ > 60000) return;}

UserToPMABufferCopy(StrPtr, ENDP1_TXADDR, ++i);

SetEPTxCount(ENDP1,i);

SetEPTxValid(ENDP1);

}

//-----------------------------------------------------------------

void USB_Send_Char(u8 ch)

{

u16 timeout = 0;

while (_GetEPTxStatus(ENDP1) != EP_TX_NAK){ if (timeout++ > 60000) return;}

UserToPMABufferCopy(&ch, ENDP1_TXADDR, 2);

SetEPTxCount(ENDP1,2);

SetEPTxValid(ENDP1);

}

//-----------------------------------------------------------------

void USB_Send_Data(u8 *data, u16 count)

{

 u16 timeout = 0;

 u8 i;

 count++;

 for (i=0;i< (count/64)+1;i++)  

 {

   while (_GetEPTxStatus(ENDP1) != EP_TX_NAK);

   if (i < (count/64))

    { UserToPMABufferCopy(&data[i*64], ENDP1_TXADDR, 64);

      SetEPTxCount(ENDP1,64);

        }

    else

    { UserToPMABufferCopy(&data[i*64], ENDP1_TXADDR, count % 64);

          SetEPTxCount(ENDP1, count % 64);

        }

   SetEPTxValid(ENDP1);

 }

}