📄 lib.c
字号:
/***************************************************************************\
Copyright (c) 2004-2007 threewater@up-tech.com, All rights reserved.
by threewter 2004.4.26
\***************************************************************************/
/***************************************************************************\
#说明: C库函数等定义
---------------------------------- Bug --------------------------------------
---------------------------------- TODO list --------------------------------------
----------------------------------修正--------------------------------------
2004-5-2 1、添加udelay,微秒级延时函数
2004-4-26 创建
\***************************************************************************/
#include "../inc/sys/lib.h"
#include "../inc/marco.h"
#include "../inc/drv/Serial.h"
#include "../inc/drv/register.h"
#include <stdarg.h>
#include <string.h>
#include <stdlib.h>
#include <stdio.h>
#include <ctype.h>
//--------------------------------SYSTEM---------------------------------//
/*************************************************************\
微秒级延时函数
参数time: 表示延时的时间,单位微秒。
如果time=0,则启用看门狗定时器,
自动计算时间
\**************************************************************/
void udelay(int time)
{
static int delayLoopCount=100;
int i,adjust=0, curpc;
#if 0
if(time==0)
{
time=adjust=20;
cal:
delayLoopCount=100;
rWDTCTRL=0x3; //MCLK/64 resolution=0.9137us timer overflow=233.9us, interrupt disable, TMEN=0
rWDTCNT=0; //clear watch dog count
rWDTCTRL|=(1<<5); //MCLK/64 resolution=0.9137us timer overflow=233.9us, interrupt disable, TMEN=1
}
for(;time>0;time--){
__asm{mov curpc, pc};
for(i=0;i<delayLoopCount;i++);
__asm{sub curpc, pc, curpc};
}
if(adjust)
{
rWDTCTRL&=(~(1<<5)); //MCLK/64 resolution=0.9137us timer overflow=233.9us, interrupt disable, TMEN=0
i=rWDTCNT;
if(rWDTSTAT & 0x2){//timer overflow. we must recalculation
adjust--;
time=adjust;
if(adjust==0){
printk("Can not get delay loop count!set it in default value: %d\n", delayLoopCount);
return;
}
goto cal;
}
delayLoopCount = delayLoopCount*adjust*(MCLK/64/i)/1000000;
printk("Get delay loop count successfully! The value is %d, ", delayLoopCount);
printk("Maybe %d MIPS\n", curpc*delayLoopCount/4);
}
#endif
}
//------------------------PORTS------------------------------//
void Port_Init(void)
{
// PORT 0 GROUP
//15 14 13 12 11 10 9 8
//GPIO GPIO GPIO GPIO GPIO GPIO RXD1 TXD1
//7 6 5 4 3 2 1 0
//GPIO MOSI0 MISIO0 SCK0 SDA SCL RXD0 TXD0
PINSEL0 = 0x00051555;
// PORT 1 GROUP
//31 30 29 28 27 26 25 24
//REV AIN3 AIN2 AIN1 AIN0 GPIO GPIO GPIO
//23 22 21 20 19 18 17 16
//GPIO GPIO GPIO GPIO GPIO GPIO GPIO GPIO
PINSEL1 = 0x15400000;
PINSEL2 = 0;
}
/************************* UART ****************************/
extern serial_driver_t* serial_drv[];
extern struct_Uart_Buffer Uart_Buffer[];
extern int NumberOfUartDrv;
serial_loop_func_t Getch_loopfunc[]={(serial_loop_func_t)NULL,(serial_loop_func_t)NULL,
(serial_loop_func_t)NULL, (serial_loop_func_t)NULL};
#define GETCH_LOOPFUNC_NUM (sizeof(Getch_loopfunc)/sizeof(serial_loop_func_t))
int Uart_Init(int whichUart, int baud)
{
#if OS_ARG_CHK_EN > 0
if(whichUart>=NumberOfUartDrv)
return FALSE;
#endif
return serial_drv[whichUart]->init(baud);
}
/*************************************************************
设置等待串口数据的时候的循环函数,
成功返回函数的序号(删除的时候使用),
如果失败则返回-1,
**************************************************************/
int Set_UartLoopFunc(serial_loop_func_t func)
{
int i;
for(i=0;Getch_loopfunc[i];i++);
if(i>=GETCH_LOOPFUNC_NUM)
return -1;
Getch_loopfunc[i]=func;
return i;
}
/*************************************************************\
清除等待串口数据的时候的循环函数,
参数是函数的序号,
成功返回TURE,失败则返回FALSE
\**************************************************************/
int Clear_UartLoopFunc(int index)
{
if(index>=GETCH_LOOPFUNC_NUM || index<0)
return FALSE;
Getch_loopfunc[index]=NULL;
return TRUE;
}
char Uart_Getch(int whichUart)
{
int i;
#if OS_ARG_CHK_EN > 0
if(whichUart>=NumberOfUartDrv)
return FALSE;
#endif
while(!serial_drv[whichUart]->poll()){
for(i=0;i<GETCH_LOOPFUNC_NUM;i++){
if(Getch_loopfunc[i])
(*Getch_loopfunc[i])();
}
}
return serial_drv[whichUart]->read();
}
//串口是否有数据输入
int Uart_Poll(int whichUart)
{
#if OS_ARG_CHK_EN > 0
if(whichUart>=NumberOfUartDrv)
return FALSE;
#endif
return serial_drv[whichUart]->poll();
}
int Uart_SendByte(int whichUart,int data)
{
#if OS_ARG_CHK_EN > 0
if(whichUart>=NumberOfUartDrv)
return FALSE;
#endif
return Uart_Buffer[whichUart].Uart_write(whichUart, (U8*)&data, 1, 0);
// return serial_drv[whichUart]->write(data);
}
void Uart_GetString(int whichUart, char *string)
{
char *string2=string;
char c;
while((c=Uart_Getch(whichUart))!='\r')
{
if(c=='\b')
{
if( (int)string2 < (int)string )
{
Uart_Printf(whichUart,"\b \b");
string--;
}
}
else
{
*string++=c;
Uart_SendByte(whichUart,c);
}
}
*string='\0';
Uart_SendByte(whichUart,'\r');
Uart_SendByte(whichUart,'\n');
}
int Uart_GetIntNum(int whichUart)
{
char str[30];
char *string=str;
int base=10;
int minus=0;
int lastIndex;
int result=0;
int i;
Uart_GetString(whichUart, string);
if(string[0]=='-')
{
minus=1;
string++;
}
if(string[0]=='0' && (string[1]=='x' || string[1]=='X'))
{
base=16;
string+=2;
}
lastIndex=strlen(string)-1;
if( string[lastIndex]=='h' || string[lastIndex]=='H' )
{
base=16;
string[lastIndex]=0;
lastIndex--;
}
if(base==10)
{
result=atoi(string);
result=minus ? (-1*result):result;
}
else
{
for(i=0;i<=lastIndex;i++)
{
if(isalpha(string[i]))
{
if(isupper(string[i]))
result=(result<<4)+string[i]-'A'+10;
else
result=(result<<4)+string[i]-'a'+10;
}
else
{
result=(result<<4)+string[i]-'0';
}
}
result=minus ? (-1*result):result;
}
return result;
}
void Uart_SendString(int whichUart, char *pt)
{
while(*pt){
if(*pt=='\n')
Uart_SendByte(whichUart,'\r');
Uart_SendByte(whichUart,*pt++);
}
}
//if you don't use vsprintf(), the code size is reduced very much.
void Uart_Printf(int whichUart, char *fmt,...)
{
va_list ap;
static char string[256];
va_start(ap,fmt);
vsprintf(string,fmt,ap);
Uart_SendString(whichUart, string);
va_end(ap);
}
/**************************************************************\
等待接收串口数据,带超时
\**************************************************************/
int Uart_GetchTimeout(int whichUart, char* pbuffer, int n, int timeout)
{
int i, t;
if(whichUart>=NumberOfUartDrv)
return FALSE;
for(;n>0;n--){
t=timeout*10;
while(!serial_drv[whichUart]->poll()){
for(i=0;i<GETCH_LOOPFUNC_NUM;i++){
if(Getch_loopfunc[i])
(*Getch_loopfunc[i])();
}
t--;
if(t==0)
return FALSE;
}
*pbuffer = serial_drv[whichUart]->read();
pbuffer++;
}
return TRUE;
}
void printfNULL(char *fmt, ...)
{
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -