583 lines
14 KiB
C++
583 lines
14 KiB
C++
#include "Sys.h"
|
||
|
||
#include "Time.h"
|
||
#include "SerialPort.h"
|
||
|
||
TSys Sys;
|
||
TTime Time;
|
||
|
||
extern uint __heap_base;
|
||
extern uint __heap_limit;
|
||
extern uint __initial_sp;
|
||
extern uint __microlib_freelist;
|
||
extern uint __microlib_freelist_initialised;
|
||
|
||
#ifndef BIT
|
||
#define BIT(x) (1 << (x))
|
||
#endif
|
||
|
||
#ifdef STM32F1
|
||
char MemNames[] = "468BCDEFGIK";
|
||
uint MemSizes[] = { 16, 32, 64, 128, 256, 384, 512, 768, 1024, 2048, 3072 };
|
||
uint RamSizes[] = { 6, 10, 20, 20, 48, 48, 64, 96, 96, 96, 96 };
|
||
#elif defined(STM32F0)
|
||
char MemNames[] = "468B";
|
||
uint MemSizes[] = { 16, 32, 64, 128 };
|
||
//uint RamSizes[] = { 4, 6, 8, 16 }; // 150x6有6kRAM
|
||
uint RamSizes[] = { 4, 4, 8, 16 };
|
||
#elif defined(STM32F4)
|
||
char MemNames[] = "468BCDEFGIK";
|
||
uint MemSizes[] = { 16, 32, 64, 128, 256, 384, 512, 768, 1024, 2048, 3072 };
|
||
uint RamSizes[] = { 6, 10, 20, 20, 48, 48, 128, 192, 128, 192, 192 };
|
||
#endif
|
||
|
||
void TSys::Reset() { NVIC_SystemReset(); }
|
||
|
||
#pragma arm section code
|
||
|
||
_force_inline void InitHeapStack(uint ramSize)
|
||
{
|
||
uint* p = (uint*)__get_MSP();
|
||
|
||
// 直接使用RAM最后，需要减去一点，因为TSys构造函数有压栈，待会需要把压栈数据也拷贝过来
|
||
uint top = SRAM_BASE + (ramSize << 10);
|
||
uint size = (uint)&__initial_sp - (uint)p;
|
||
uint msp = top - size;
|
||
// 拷贝一部分栈内容到新栈
|
||
//memset((void*)msp, 0, size);
|
||
memcpy((void*)msp, (void*)p, size);
|
||
|
||
// 必须先拷贝完成栈，再修改栈指针
|
||
__set_MSP(msp); // 左移10位，就是乘以1024
|
||
|
||
// 这个时候还没有初始化堆，我们来设置堆到内存最大值，让堆栈共用RAM剩下全部
|
||
//__microlib_freelist
|
||
p = &__heap_base + 1;
|
||
if(!__microlib_freelist_initialised)
|
||
{
|
||
//*(uint*)&__heap_limit = top;
|
||
// 堆顶地址__heap_limit被编译固化到malloc函数附近，无法修改。只能这里负责初始化整个堆
|
||
__microlib_freelist = (uint)p; // 空闲链表指针
|
||
// 设置堆大小，直达天花板
|
||
*p = (top - (uint)p) & 0xFFFFFFF8; // 空闲链表剩余大小
|
||
*(p + 1) = 0;
|
||
|
||
__microlib_freelist_initialised = 1;
|
||
}
|
||
else
|
||
{
|
||
//// 如果已经初始化堆，则直接增加大小即可
|
||
//*p += (top - (uint)&__heap_limit) & 0xFFFFFFF8; // 空闲链表剩余大小
|
||
|
||
// 需要找到最后一个空闲节点，然后把大小加上去
|
||
uint* p = (uint*)__microlib_freelist;
|
||
// 每一个节点由4字节大小以及4字节下一节点的指针组成
|
||
while(*(p + 1)) p = (uint*)*(p + 1);
|
||
|
||
// 给最后一个空闲节点增加大小
|
||
*p += (top - (uint)p) & 0xFFFFFFF8; // 空闲链表剩余大小
|
||
}
|
||
}
|
||
|
||
bool TSys::CheckMemory()
|
||
{
|
||
#if DEBUG
|
||
uint msp = __get_MSP();
|
||
|
||
//if(__microlib_freelist >= msp) return false;
|
||
assert_param2(__microlib_freelist + 0x40 < msp, "堆栈相互穿透，内存已用完！可能是堆分配或野指针带来了内存泄漏！");
|
||
|
||
// 如果堆只剩下64字节，则报告失败，要求用户扩大堆空间以免不测
|
||
//uint end = SRAM_BASE + (RAMSize << 10);
|
||
//if(__microlib_freelist + 0x40 >= end) return false;
|
||
assert_param2(__microlib_freelist + 0x40 < SRAM_BASE + (RAMSize << 10), "堆栈相互穿透，内存已用完！一定是堆分配带来了内存泄漏！");
|
||
#endif
|
||
|
||
return true;
|
||
}
|
||
|
||
// 获取JTAG编号，ST是0x041，GD是0x7A3
|
||
uint16_t Get_JTAG_ID()
|
||
{
|
||
if( *( uint8_t *)( 0xE00FFFE8 ) & 0x08 )
|
||
{
|
||
return ((*(uint8_t *)(0xE00FFFD0) & 0x0F ) << 8 ) |
|
||
((*(uint8_t *)(0xE00FFFE4) & 0xFF ) >> 3 ) |
|
||
((*(uint8_t *)(0xE00FFFE8) & 0x07 ) << 5 ) + 1 ;
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
bool SysError(uint code)
|
||
{
|
||
debug_printf("系统错误！0x%02x\r\n", code);
|
||
|
||
#if DEBUG
|
||
ShowFault(code);
|
||
|
||
SerialPort* sp = SerialPort::GetMessagePort();
|
||
if(sp) sp->Flush();
|
||
#endif
|
||
|
||
return true;
|
||
}
|
||
|
||
void SysStop()
|
||
{
|
||
debug_printf("系统停止！\r\n");
|
||
//while(true);
|
||
}
|
||
|
||
TSys::TSys()
|
||
{
|
||
#ifdef STM32F0
|
||
Clock = 48000000;
|
||
#elif defined(STM32F1)
|
||
Clock = 72000000;
|
||
#elif defined(STM32F4)
|
||
Clock = 168000000;
|
||
#endif
|
||
//CystalClock = 8000000; // 晶振时钟
|
||
CystalClock = HSE_VALUE; // 晶振时钟
|
||
MessagePort = COM1; // COM1;
|
||
|
||
bool IsGD = Get_JTAG_ID() == 0x7A3;
|
||
|
||
#ifdef STM32F0
|
||
void* p = (void*)0x1FFFF7AC; // 手册里搜索UID，优先英文手册
|
||
#elif defined(STM32F1)
|
||
void* p = (void*)0x1FFFF7E8;
|
||
#elif defined(STM32F4)
|
||
void* p = (void*)0x1FFF7A10;
|
||
#endif
|
||
memcpy(ID, p, ArrayLength(ID));
|
||
|
||
CPUID = SCB->CPUID;
|
||
uint mcuid = DBGMCU->IDCODE; // MCU编码。低字设备版本，高字子版本
|
||
if(mcuid == 0 && IsGD) mcuid = *(uint*)0xE0042000; // 用GD32F103的位置
|
||
RevID = mcuid >> 16;
|
||
DevID = mcuid & 0x0FFF;
|
||
|
||
// GD32F103 默认使用120M
|
||
if(IsGD && (DevID == 0x0430 || DevID == 0x0414)) Clock = 120000000;
|
||
|
||
_Index = 0;
|
||
#ifndef TINY
|
||
#ifdef STM32F0
|
||
if(IsGD)
|
||
FlashSize = *(__IO ushort *)(0x1FFFF7E0); // 容量
|
||
else
|
||
FlashSize = *(__IO ushort *)(0x1FFFF7CC); // 容量。手册里搜索FLASH_SIZE，优先英文手册
|
||
#elif defined(STM32F1)
|
||
FlashSize = *(__IO ushort *)(0x1FFFF7E0); // 容量
|
||
#elif defined(STM32F4)
|
||
FlashSize = *(__IO ushort *)(0x1FFF7A22); // 容量
|
||
#endif
|
||
if(FlashSize != 0xFFFF)
|
||
{
|
||
RAMSize = FlashSize >> 3; // 通过Flash大小和MCUID识别型号后得知内存大小
|
||
for(int i=0; i<ArrayLength(MemSizes); i++)
|
||
{
|
||
if(MemSizes[i] == Sys.FlashSize)
|
||
{
|
||
_Index = i;
|
||
break;
|
||
}
|
||
}
|
||
RAMSize = RamSizes[_Index];
|
||
}
|
||
|
||
InitHeapStack(RAMSize);
|
||
#endif
|
||
|
||
StartTime = 0;
|
||
OnTick = NULL;
|
||
OnSleep = NULL;
|
||
|
||
#if DEBUG
|
||
OnError = SysError;
|
||
OnStop = SysStop;
|
||
#else
|
||
OnError = 0;
|
||
OnStop = 0;
|
||
#endif
|
||
|
||
#ifdef STM32F10X
|
||
// 关闭JTAG仿真接口，只打开SW仿真。
|
||
RCC->APB2ENR |= RCC_APB2ENR_AFIOEN; // 打开时钟
|
||
AFIO->MAPR |= AFIO_MAPR_SWJ_CFG_JTAGDISABLE; //关闭JTAG仿真接口，只打开SW仿真。
|
||
#endif
|
||
|
||
Code = 0x0000;
|
||
Version = 0x0300;
|
||
#ifndef TINY
|
||
Name = "SmartOS";
|
||
Company = "NewLife_Embedded_Team";
|
||
BuildTime = "yyyy-MM-dd HH:mm:ss";
|
||
|
||
Interrupt.Init();
|
||
#endif
|
||
|
||
Started = false;
|
||
OnStart = NULL;
|
||
}
|
||
|
||
/*TSys::~TSys()
|
||
{
|
||
if(OnStop) OnStop();
|
||
}*/
|
||
|
||
void ShowTime(void* param)
|
||
{
|
||
debug_printf("\r");
|
||
Time.Now().Show();
|
||
debug_printf(" ");
|
||
}
|
||
|
||
void TSys::InitClock()
|
||
{
|
||
// 获取当前频率
|
||
uint clock = RCC_GetSysClock();
|
||
// 如果当前频率不等于配置，则重新配置时钟
|
||
if(Clock != clock || CystalClock != HSE_VALUE)
|
||
{
|
||
SetSysClock(Clock, CystalClock);
|
||
|
||
#ifdef STM32F4
|
||
HSE_VALUE = CystalClock;
|
||
#endif
|
||
Clock = RCC_GetSysClock();
|
||
SystemCoreClock = Clock;
|
||
}
|
||
}
|
||
|
||
void TSys::Init(void)
|
||
{
|
||
InitClock();
|
||
|
||
// 必须在系统主频率确定以后再初始化时钟
|
||
Time.Init();
|
||
}
|
||
|
||
#if DEBUG
|
||
typedef struct
|
||
{
|
||
byte Revision:4; // The p value in the Rnpn product revision identifier, indicates patch release.0x0: patch 0
|
||
ushort PartNo:12; // Part number of the processor. 0xC20: Cortex-M0
|
||
byte Constant:4; // Constant that defines the architecture of the processor. 0xC: ARMv6-M architecture
|
||
byte Variant:4; // Variant number: The r value in the Rnpn product revision identifier. 0x0: revision 0
|
||
byte Implementer; // Implementer code. 0x41 ARM
|
||
}ST_CPUID;
|
||
#endif
|
||
|
||
void TSys::ShowInfo()
|
||
{
|
||
#if DEBUG
|
||
// 刚刚初始化完成的时间
|
||
ulong initedTime = Time.Current();
|
||
|
||
byte* ver = (byte*)&Version;
|
||
debug_printf("%s::%s Code:%04X ", Company, Name, Code);
|
||
debug_printf("Ver:%x.%x Build:%s\r\n", *ver++, *ver++, BuildTime);
|
||
debug_printf("SmartOS::");
|
||
bool IsGD = Get_JTAG_ID() == 0x7A3;
|
||
if(IsGD)
|
||
debug_printf("GD32");
|
||
else
|
||
debug_printf("STM32");
|
||
|
||
ST_CPUID* cpu = (ST_CPUID*)&CPUID;
|
||
if(DevID > 0)
|
||
{
|
||
if(DevID == 0x410)
|
||
{
|
||
if(IsGD && RevID == 0x1303)
|
||
{
|
||
if(Clock == 48000000)
|
||
debug_printf("F130");
|
||
else
|
||
debug_printf("F150");
|
||
}
|
||
#ifdef STM32F1
|
||
else
|
||
debug_printf("F103");
|
||
#endif
|
||
}
|
||
#ifdef STM32F1
|
||
else if(DevID == 0x412 || DevID == 0x414 || DevID == 0x430)
|
||
debug_printf("F103");
|
||
else if(DevID == 0x418)
|
||
debug_printf("F107");
|
||
else if(DevID == 0x412)
|
||
debug_printf("F130");
|
||
#endif
|
||
#ifdef STM32F4
|
||
else if(DevID == 0x413)
|
||
debug_printf("F407");
|
||
#endif
|
||
else if(DevID == 0x440 || DevID == 0x444) // F030x4/F030x6=0x444 F030x8=0x440
|
||
debug_printf("F030/F051");
|
||
else
|
||
debug_printf("F%03x", DevID);
|
||
}
|
||
else if(CPUID > 0)
|
||
{
|
||
if(Clock == 48000000)
|
||
debug_printf("F130/F150");
|
||
#ifdef STM32F1
|
||
else
|
||
debug_printf("F103");
|
||
#endif
|
||
}
|
||
|
||
// 暂时不知道怎么计算引脚，一般F4/F6/C8CB/RB/VC/VE
|
||
if(_Index < 2)
|
||
debug_printf("F");
|
||
else if(_Index < 4)
|
||
debug_printf("C");
|
||
else if(_Index < 6)
|
||
debug_printf("R");
|
||
else
|
||
debug_printf("V");
|
||
debug_printf("%c", MemNames[_Index]);
|
||
//debug_printf("\r\n");
|
||
|
||
// 系统信息
|
||
//debug_printf(" %dMHz Flash:%dk RAM:%dk\r\n", Clock/1000000, FlashSize, RAMSize);
|
||
// 获取当前频率
|
||
debug_printf(" %dMHz Flash:%dk RAM:%dk\r\n", RCC_GetSysClock()/1000000, FlashSize, RAMSize);
|
||
//debug_printf("\r\n");
|
||
debug_printf("DevID:0x%04X RevID:0x%04X \r\n", DevID, RevID);
|
||
|
||
debug_printf("CPUID:0x%08X", CPUID);
|
||
if(cpu->Implementer == 0x41) debug_printf(" ARM:");
|
||
if(cpu->Constant == 0x0C)
|
||
debug_printf(" ARMv6-M");
|
||
else if(cpu->Constant == 0x0F)
|
||
debug_printf(" ARMv7-M");
|
||
if((cpu->PartNo & 0x0FF0) == 0x0C20) debug_printf(" Cortex-M%d:", cpu->PartNo & 0x0F);
|
||
debug_printf(" R%dp%d", cpu->Revision, cpu->Variant);
|
||
debug_printf("\r\n");
|
||
debug_printf("ChipID:");
|
||
ShowHex(ID, ArrayLength(ID), '-');
|
||
|
||
debug_printf("\t");
|
||
ShowString(ID, 12, false);
|
||
debug_printf("\r\n");
|
||
|
||
// 输出堆信息
|
||
uint start = (uint)&__heap_base;
|
||
// F4有64k的CCM内存
|
||
#if defined(STM32F4)
|
||
if(start < 0x20000000) start = 0x20000000;
|
||
#endif
|
||
uint end = SRAM_BASE + (RAMSize << 10);
|
||
debug_printf("Heap :(0x%08x, 0x%08x) = 0x%x (%dk)\r\n", start, end, end - start, (end - start) / 1024);
|
||
start = (uint)&__heap_limit;
|
||
#if defined(STM32F4)
|
||
if(start < 0x20000000) start = 0x20000000;
|
||
#endif
|
||
//end = 0x20000000 + (RAMSize << 10);
|
||
debug_printf("Stack:(0x%08x, 0x%08x) = 0x%x (%dk)\r\n", start, end, end - start, (end - start) / 1024);
|
||
|
||
debug_printf("Time : ");
|
||
Time.Now().Show(true);
|
||
// 系统启动时间
|
||
debug_printf("Start: %dms (Inited: %dms)\r\n", (uint)(Time.Current() - StartTime), (uint)(initedTime - StartTime));
|
||
debug_printf("技术支持: http://www.NewLifeX.com\r\n");
|
||
|
||
debug_printf("\r\n");
|
||
#endif
|
||
}
|
||
|
||
#define __HELP__MODULE__ 1
|
||
#ifdef __HELP__MODULE__
|
||
// 显示十六进制数据，指定分隔字符
|
||
void TSys::ShowHex(byte* buf, uint len, char sep)
|
||
{
|
||
for(int i=0; i < len; i++)
|
||
{
|
||
debug_printf("%02X", *buf++);
|
||
if(i < len - 1 && sep != '\0') debug_printf("%c", sep);
|
||
//if(((i + 1) & 0xF) == 0) debug_printf("\r\n");
|
||
}
|
||
//debug_printf("\r\n");
|
||
}
|
||
|
||
// 显示字符串，不指定长度时自动找\0
|
||
void TSys::ShowString(byte* buf, uint len, bool autoEnd)
|
||
{
|
||
if(len == 0) len = 1000;
|
||
for(int i=0; i<len; i++)
|
||
{
|
||
if(buf[i] == 0 && autoEnd) return;
|
||
if(buf[i] >= 32 && buf[i] <= 126 || buf[i] == 0x0A || buf[i] == 0x0D || buf[i] == 0x09)
|
||
debug_printf("%c", buf[i]);
|
||
else
|
||
debug_printf("%02X", buf[i]);
|
||
}
|
||
}
|
||
|
||
// 源数据src转为十六进制字符编码再放入目标字符buf，比如0xA8在目标放两个字节0x41(A) 0x38(8)
|
||
void TSys::ToHex(byte* buf, byte* src, uint len)
|
||
{
|
||
for(int i=0; i < len; i++, src++)
|
||
{
|
||
byte n = *src >> 4;
|
||
if(n < 10)
|
||
n += '0';
|
||
else
|
||
n += 'A' - 10;
|
||
*buf++ = n;
|
||
|
||
n = *src & 0x0F;
|
||
if(n < 10)
|
||
n += '0';
|
||
else
|
||
n += 'A' - 10;
|
||
*buf++ = n;
|
||
}
|
||
}
|
||
#endif
|
||
|
||
#define __TASK__MODULE__ 1
|
||
#ifdef __TASK__MODULE__
|
||
|
||
// 任务
|
||
#include "Task.h"
|
||
|
||
// 创建任务，返回任务编号。dueTime首次调度时间ms，period调度间隔ms，-1表示仅处理一次
|
||
uint TSys::AddTask(Action func, void* param, int dueTime, int period, string name)
|
||
{
|
||
return Task::Scheduler()->Add(func, param, dueTime, period, name);
|
||
}
|
||
|
||
void TSys::RemoveTask(uint& taskid)
|
||
{
|
||
if(taskid) Task::Scheduler()->Remove(taskid);
|
||
taskid = 0;
|
||
}
|
||
|
||
bool TSys::SetTask(uint taskid, bool enable, int msNextTime)
|
||
{
|
||
if(!taskid) return false;
|
||
|
||
Task* task = Task::Get(taskid);
|
||
if(!task) return false;
|
||
|
||
task->Enable = enable;
|
||
|
||
// 可以安排最近一次执行的时间，比如0表示马上调度执行
|
||
if(msNextTime >= 0) task->NextTime = Time.Current() + msNextTime;
|
||
|
||
// 如果系统调度器处于Sleep，让它立马退出
|
||
if(enable) Task::Scheduler()->Sleeping = false;
|
||
|
||
return true;
|
||
}
|
||
|
||
// 改变任务周期
|
||
bool TSys::SetTaskPeriod(uint taskid, int period)
|
||
{
|
||
if(!taskid) return false;
|
||
|
||
Task* task = Task::Get(taskid);
|
||
if(!task) return false;
|
||
|
||
if(period)
|
||
task->Period = period;
|
||
else
|
||
task->Enable = false;
|
||
|
||
return true;
|
||
}
|
||
|
||
void TSys::Start()
|
||
{
|
||
Started = true;
|
||
#if DEBUG
|
||
//AddTask(ShowTime, NULL, 2000000, 2000000);
|
||
#endif
|
||
if(OnStart)
|
||
{
|
||
// 设置重载值，让其每1ms重载一次
|
||
//Time.SetMax(1000);
|
||
OnStart();
|
||
}
|
||
else
|
||
Task::Scheduler()->Start();
|
||
}
|
||
|
||
void TimeSleep(uint us)
|
||
{
|
||
// 在这段时间里面，去处理一下别的任务
|
||
if(Sys.Started && us != 0 && us >= 50)
|
||
{
|
||
TaskScheduler* sc = Task::Scheduler();
|
||
// 记录当前正在执行任务
|
||
Task* task = sc->Current;
|
||
|
||
TimeCost tc;
|
||
// 实际可用时间。100us一般不够调度新任务，留给硬件等待
|
||
int total = us;
|
||
// 如果休眠时间足够长，允许多次调度其它任务
|
||
while(true)
|
||
{
|
||
// 统计这次调度的时间，累加作为当前任务的休眠时间
|
||
TimeCost tc2;
|
||
|
||
sc->Execute(total / 1000);
|
||
|
||
total -= tc2.Elapsed();
|
||
|
||
if(total <= 0) break;
|
||
}
|
||
|
||
int ct = tc.Elapsed();
|
||
if(task)
|
||
{
|
||
sc->Current = task;
|
||
task->SleepTime += ct;
|
||
}
|
||
|
||
if(ct >= us) return;
|
||
|
||
us -= ct;
|
||
}
|
||
if(us) Time.Delay(us);
|
||
}
|
||
|
||
void TSys::Sleep(uint ms)
|
||
{
|
||
// 优先使用线程级睡眠
|
||
if(OnSleep)
|
||
OnSleep(ms);
|
||
else
|
||
{
|
||
#if DEBUG
|
||
if(ms > 1000) debug_printf("Sys::Sleep 设计错误，睡眠%dms太长！", ms);
|
||
#endif
|
||
|
||
TimeSleep(ms * 1000);
|
||
}
|
||
}
|
||
|
||
void TSys::Delay(uint us)
|
||
{
|
||
// 如果延迟微秒数太大，则使用线程级睡眠
|
||
if(OnSleep && us >= 2000)
|
||
OnSleep((us + 500) / 1000);
|
||
else
|
||
{
|
||
#if DEBUG
|
||
if(us > 1000000) debug_printf("Sys::Sleep 设计错误，睡眠%dus太长！", us);
|
||
#endif
|
||
|
||
if(us < 50)
|
||
Time.Delay(us);
|
||
else
|
||
TimeSleep(us);
|
||
}
|
||
}
|
||
#endif
|