Merge Dev into mainline (#1)
* Removing USB Need to refine the drive to the iron tip * Update README.md * * Rewrite all code from scratch * Only kept settings * New font * New PID * New Menus * Use Hardware I2C * Faster System * Better Heating Time * No USB * Full Menu System
This commit is contained in:
Ben V. Brown
GitHub
@@ -1,284 +0,0 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. ********************
|
||||
File Name : 2FAT12.c
|
||||
Version : S100 APP Ver 2.11
|
||||
Description:
|
||||
Author : bure & Celery
|
||||
Data: 2015/08/03
|
||||
History:
|
||||
2016/09/13 Ben V. Brown -> English comments and cleaning up
|
||||
2015/08/03
|
||||
*******************************************************************************/
|
||||
#include <string.h>
|
||||
#include "FAT12.h"
|
||||
#include "Bios.h"
|
||||
|
||||
#define FAT_LEN 0x1800
|
||||
#define FAT1_BASE 0x00001000 // FAT1
|
||||
#define FAT2_BASE 0x00002800 // FAT2
|
||||
#define ROOT_BASE 0x00004000 //
|
||||
#define FILE_BASE 0x00008000 //
|
||||
#define SEC_LEN 512 //length of a sector -> 512 Bytes
|
||||
#define FAT1_SEC 0x0C // FAT1 Sector
|
||||
#define FAT2_SEC 0x0C // FAT2 Sector
|
||||
|
||||
#define OK 0 //Error codes
|
||||
#define SEC_ERR 1 //
|
||||
#define FAT_ERR 2 //
|
||||
#define OVER 3 //
|
||||
#define NEW 4 //
|
||||
#define END 0xFFF //
|
||||
|
||||
#define OW 0 //
|
||||
#define RW 1 //
|
||||
|
||||
/*******************************************************************************
|
||||
Function: NextCluster
|
||||
Description:
|
||||
Input:
|
||||
*******************************************************************************/
|
||||
u8 NextCluster(u16* pCluster) {
|
||||
u16 FatNum;
|
||||
u32 Addr = FAT1_BASE + (*pCluster + *pCluster / 2);
|
||||
|
||||
*(pCluster + 1) = *pCluster; // <20><><EFBFBD><EFBFBD>ǰһ<C7B0><D2BB><EFBFBD>غ<EFBFBD>
|
||||
// *(pCluster+1)= 0;
|
||||
if ((*pCluster >= END) || (*pCluster < 2))
|
||||
return OK;
|
||||
if (ReadDiskData((u8*) &FatNum, Addr, 2) != OK)
|
||||
return SEC_ERR;
|
||||
*pCluster = (*pCluster & 1) ? (FatNum >> 4) : (FatNum & 0x0FFF); // ָ<><D6B8><EFBFBD><EFBFBD>һ<EFBFBD><D2BB><EFBFBD>غ<EFBFBD>
|
||||
return OK;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: ReadFileSec
|
||||
Description:
|
||||
Input:
|
||||
*******************************************************************************/
|
||||
u8 ReadFileSec(u8* pBuffer, u16* pCluster) {
|
||||
u32 ReadAddr = FILE_BASE + SEC_LEN * (*pCluster - 2);
|
||||
//This code appears to read the data in two chunks of 256 bytes...
|
||||
if (ReadDiskData(pBuffer, ReadAddr, 256) != OK)
|
||||
return SEC_ERR; //
|
||||
pBuffer += 256;
|
||||
ReadAddr += 256;
|
||||
if (ReadDiskData(pBuffer, ReadAddr, 256) != OK)
|
||||
return SEC_ERR; // Failed to read the sector
|
||||
if (NextCluster(pCluster) != 0)
|
||||
return FAT_ERR; //
|
||||
return OK;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: ProgFileSec
|
||||
Description:
|
||||
Input:
|
||||
*******************************************************************************/
|
||||
u8 ProgFileSec(u8* pBuffer, u16* pCluster) {
|
||||
u16 Tmp;
|
||||
u32 ProgAddr = FILE_BASE + SEC_LEN * (*pCluster - 2);
|
||||
|
||||
if (ProgDiskPage(pBuffer, ProgAddr) != OK)
|
||||
return SEC_ERR; //
|
||||
pBuffer += 256;
|
||||
ProgAddr += 256;
|
||||
if (ProgDiskPage(pBuffer, ProgAddr) != OK)
|
||||
return SEC_ERR; //
|
||||
Tmp = *pCluster;
|
||||
switch (Tmp) {
|
||||
case 0:
|
||||
case 1:
|
||||
if (SeekBlank(pBuffer, pCluster) != OK)
|
||||
return OVER;
|
||||
if (SetCluster(pBuffer, pCluster) != OK)
|
||||
return SEC_ERR;
|
||||
*(pCluster + 1) = Tmp;
|
||||
return OK;
|
||||
case END:
|
||||
default:
|
||||
if (NextCluster(pCluster) != OK)
|
||||
return FAT_ERR;
|
||||
return OK;
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: SeekBlank
|
||||
Description:
|
||||
Input:
|
||||
*******************************************************************************/
|
||||
u8 SeekBlank(u8* pBuffer, u16* pCluster) {
|
||||
u16 Offset, Tmp, i, n = 0;
|
||||
u32 SecAddr;
|
||||
|
||||
for (i = 0; i < 4096; i++) {
|
||||
Offset = i + i / 2;
|
||||
if ((Offset % 256) == 0) {
|
||||
SecAddr = FAT1_BASE + (Offset & (~0xFF));
|
||||
if (ReadDiskData(pBuffer, SecAddr, 258) != 0)
|
||||
return SEC_ERR;
|
||||
}
|
||||
Offset %= 256;
|
||||
Tmp = pBuffer[Offset] + (pBuffer[Offset + 1] << 8);
|
||||
Tmp = (i & 1) ? (Tmp >> 4) : (Tmp & 0xFFF);
|
||||
if (Tmp == 0) {
|
||||
*pCluster++ = i;
|
||||
n++;
|
||||
if (n > 1)
|
||||
return OK;
|
||||
}
|
||||
}
|
||||
*(pCluster + 1) = 0xFFF;
|
||||
return OK;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description:
|
||||
Input:
|
||||
*******************************************************************************/
|
||||
u8 SetCluster(u8* pBuffer, u16* pCluster) {
|
||||
u16 Offset, Tmp, i, k;
|
||||
u32 SecAddr;
|
||||
|
||||
i = *pCluster; // <20><>ȡԭ<C8A1><D4AD>ǰ<EFBFBD>غ<EFBFBD>
|
||||
k = *(pCluster + 1); // <20><>ȡ<EFBFBD><C8A1>һ<EFBFBD>غ<EFBFBD>
|
||||
*pCluster = k;
|
||||
Offset = i + i / 2;
|
||||
SecAddr = FAT1_BASE + (Offset & (~0xFF));
|
||||
Tmp = Offset & 0xFF;
|
||||
if (ReadDiskData(pBuffer, SecAddr, 256) != 0)
|
||||
return SEC_ERR;
|
||||
if (i & 1)
|
||||
pBuffer[Tmp] = ((k << 4) & 0xF0) + (pBuffer[Tmp] & 0x0F);
|
||||
else
|
||||
pBuffer[Tmp] = k;
|
||||
if (Tmp++ < 256) {
|
||||
if (i & 1)
|
||||
pBuffer[Tmp] = k >> 4;
|
||||
else
|
||||
pBuffer[Tmp] = ((k >> 8) & 0x0F) + (pBuffer[Tmp] & 0xF0);
|
||||
if (ProgDiskPage(pBuffer, SecAddr) != 0)
|
||||
return SEC_ERR;
|
||||
} else {
|
||||
if (ProgDiskPage(pBuffer, SecAddr) != 0)
|
||||
return SEC_ERR;
|
||||
SecAddr += 256;
|
||||
if (ReadDiskData(pBuffer, SecAddr, 256) != 0)
|
||||
return SEC_ERR;
|
||||
if (i & 1)
|
||||
pBuffer[0] = k >> 4;
|
||||
else
|
||||
pBuffer[0] = ((k >> 8) & 0x0F) + (pBuffer[0] & 0xF0);
|
||||
if (ProgDiskPage(pBuffer, SecAddr) != 0)
|
||||
return SEC_ERR;
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description:
|
||||
Input:
|
||||
*******************************************************************************/
|
||||
u8 FAT_SearchFile(u8* pBuffer, u8* pFileName, u16* pCluster, u32* pDirAddr,
|
||||
u32* flag) {
|
||||
u16 i, n;
|
||||
|
||||
*pCluster = 0;
|
||||
for (*pDirAddr = ROOT_BASE; *pDirAddr < FILE_BASE;) {
|
||||
if (ReadDiskData(pBuffer, *pDirAddr, 256) != OK)
|
||||
return SEC_ERR;
|
||||
for (n = 0; n < 256; n += 32) {
|
||||
for (i = 0; i < 4; i++) {
|
||||
if (pBuffer[n + i] != 0) {
|
||||
if (pBuffer[n + i] != pFileName[i])
|
||||
break;
|
||||
if (i == 3) { // <20>ҵ<EFBFBD><D2B5>ļ<EFBFBD><C4BC><EFBFBD>
|
||||
*pCluster = *(u16*) (pBuffer + n + 0x1A); // <20>ļ<EFBFBD><C4BC><EFBFBD>һ<EFBFBD><D2BB><EFBFBD>غ<EFBFBD>
|
||||
return OK;
|
||||
}
|
||||
} else
|
||||
return NEW; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>һ<EFBFBD><D2BB><EFBFBD>հ<EFBFBD>Ŀ¼<C4BF><C2BC><EFBFBD>
|
||||
}
|
||||
*pDirAddr += 32;
|
||||
}
|
||||
}
|
||||
return OVER;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:OpenFileRd
|
||||
Description: Opens a file for reading from
|
||||
Input:
|
||||
*******************************************************************************/
|
||||
u8 OpenFileRd(u8* pBuffer, u8* pFileName, u16* pCluster, u32* pDirAddr) {
|
||||
u16 i, n;
|
||||
|
||||
*pCluster = 0;
|
||||
for (*pDirAddr = ROOT_BASE; *pDirAddr < FILE_BASE;) {
|
||||
if (ReadDiskData(pBuffer, *pDirAddr, 256) != OK)
|
||||
return SEC_ERR;
|
||||
for (n = 0; n < 256; n += 32) {
|
||||
for (i = 0; i < 11; i++) {
|
||||
if (pBuffer[n + i] != 0) {
|
||||
if (pBuffer[n + i] != pFileName[i])
|
||||
break;
|
||||
if (i == 10) { // <20>ҵ<EFBFBD><D2B5>ļ<EFBFBD><C4BC><EFBFBD>
|
||||
*pCluster = *(u16*) (pBuffer + n + 0x1A); // <20>ļ<EFBFBD><C4BC><EFBFBD>һ<EFBFBD><D2BB><EFBFBD>غ<EFBFBD>
|
||||
return OK;
|
||||
}
|
||||
} else
|
||||
return NEW; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>һ<EFBFBD><D2BB><EFBFBD>հ<EFBFBD>Ŀ¼<C4BF><C2BC><EFBFBD>
|
||||
}
|
||||
*pDirAddr += 32;
|
||||
}
|
||||
}
|
||||
return OVER;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: OpenFileWr
|
||||
Description: Opens a file for writing to
|
||||
Input:
|
||||
*******************************************************************************/
|
||||
u8 OpenFileWr(u8* pBuffer, u8* pFileName, u16* pCluster, u32* pDirAddr) {
|
||||
u16 i, n;
|
||||
|
||||
i = OpenFileRd(pBuffer, pFileName, pCluster, pDirAddr);
|
||||
if (i != NEW)
|
||||
return i;
|
||||
else { // <20><>ǰ<EFBFBD><C7B0>Ϊ<EFBFBD>հ<EFBFBD>Ŀ¼<C4BF><C2BC>
|
||||
if (SeekBlank(pBuffer, pCluster) != OK)
|
||||
return OVER; // <20><>FAT<41><54><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
n = *pDirAddr & 0xFF; // nΪ<6E><CEAA>ǰҳĿ¼<C4BF><C2BC>
|
||||
if (ReadDiskData(pBuffer, (*pDirAddr) - n, 256) != OK)
|
||||
return SEC_ERR;
|
||||
for (i = 0; i < 11; i++)
|
||||
pBuffer[n + i] = pFileName[i]; // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ŀ¼<C4BF><C2BC>
|
||||
*(u16*) (pBuffer + n + 0x1A) = *pCluster;
|
||||
if (ProgDiskPage(pBuffer, (*pDirAddr) - n) != OK)
|
||||
return SEC_ERR;
|
||||
return OK;
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: CloseFile
|
||||
Description: Closes a file that was previously opened
|
||||
Input:
|
||||
*******************************************************************************/
|
||||
u8 CloseFile(u8* pBuffer, u32 Lenght, u16* pCluster, u32* pDirAddr) {
|
||||
u16 n;
|
||||
|
||||
// *pCluster = *(pCluster+1); // <20><>ȡǰһ<C7B0><D2BB><EFBFBD>غ<EFBFBD>
|
||||
*(pCluster + 1) = 0xFFF;
|
||||
SetCluster(pBuffer, pCluster);
|
||||
if (ReadDiskData(pBuffer, (*pDirAddr & (~0xFF)), 256) != OK)
|
||||
return SEC_ERR;
|
||||
*(u8*) (pBuffer + (*pDirAddr & 0xFF) + 0x0B) = 0x20;
|
||||
*(u32*) (pBuffer + (*pDirAddr & 0xFF) + 0x1C) = Lenght;
|
||||
if (ProgDiskPage(pBuffer, (*pDirAddr & (~0xFF))) != OK)
|
||||
return SEC_ERR;
|
||||
for (n = 0; n < FAT1_SEC; n++) {
|
||||
if (ReadDiskData(pBuffer, FAT1_BASE + n * 256, 256) != OK)
|
||||
return SEC_ERR;
|
||||
if (ProgDiskPage(pBuffer, FAT2_BASE + n * 256) != OK)
|
||||
return SEC_ERR;
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
/******************************** END OF FILE *********************************/
|
||||
123
workspace/ts100/src/Analog.c
Normal file
123
workspace/ts100/src/Analog.c
Normal file
@@ -0,0 +1,123 @@
|
||||
/*
|
||||
* Analog.c
|
||||
*
|
||||
* Created on: 20 Sep 2016
|
||||
* Author: ralim
|
||||
* Contains the functions related to reading and scaling the adc pins
|
||||
* This is used for temperature and battery voltage sense
|
||||
*/
|
||||
#include "Analog.h"
|
||||
|
||||
//Reads the dc input and returns it as X10 voltage (ie 236 = 23.6V)
|
||||
//Seems unstable below 9.5V input
|
||||
uint16_t readDCVoltage() {
|
||||
uint16_t reading = 0;
|
||||
for (u8 i = 0; i < 10; i++) {
|
||||
reading += ADC_GetConversionValue(ADC2);
|
||||
}
|
||||
reading /= 144; //take the average and convert to X10 voltage
|
||||
return reading; //return the read voltage
|
||||
}
|
||||
|
||||
//This reads the thermocouple in the tip
|
||||
//This allows us to read it in X10 mode
|
||||
//Returns temperature in C X10 mode
|
||||
int16_t readTipTemp() {
|
||||
static uint32_t rollingAverage[4];
|
||||
static uint8_t rIndex = 0;
|
||||
|
||||
/*The head has a thermocouple inline with the heater
|
||||
This is read by turning off the heater
|
||||
Then read the output of the op-amp that is connected across the connections
|
||||
*/
|
||||
uint32_t ad_sum = 0;
|
||||
uint32_t max = 0, min;
|
||||
uint32_t ad_value, avg_data;
|
||||
uint32_t timer = getIronTimer();
|
||||
setIronTimer(0); //set the remaining time to zero
|
||||
HEAT_OFF(); //heater must be off
|
||||
delayMs(5); //wait for the heater to time out
|
||||
uint8_t gMeas_cnt = 9; //how many measurements to make
|
||||
max = ad_sum = min = Get_ADC1Value(0);
|
||||
|
||||
while (gMeas_cnt > 0) {
|
||||
ad_value = Get_ADC1Value(0);
|
||||
ad_sum += ad_value;
|
||||
if (ad_value > max)
|
||||
max = ad_value;
|
||||
if (ad_value < min)
|
||||
min = ad_value;
|
||||
|
||||
gMeas_cnt--;
|
||||
}
|
||||
setIronTimer(timer);
|
||||
ad_sum = ad_sum - max - min; //remove the two outliers
|
||||
avg_data = ad_sum / 8; //take the average
|
||||
rollingAverage[rIndex] = avg_data;
|
||||
rIndex = (rIndex + 1) % 4;
|
||||
return (rollingAverage[0] + rollingAverage[1] + rollingAverage[2]
|
||||
+ rollingAverage[3]) / 4; //get the average
|
||||
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description:Reads the temperature of the on board temp sensor for calibration
|
||||
http://www.analog.com/media/en/technical-documentation/data-sheets/TMP35_36_37.pdf
|
||||
Output: The onboardTemp in C X 10
|
||||
*******************************************************************************/
|
||||
int readSensorTemp(void) {
|
||||
static uint32_t rollingAverage[4];
|
||||
static uint8_t rIndex = 0;
|
||||
u32 ad_sum = 0;
|
||||
u32 max, min;
|
||||
u32 ad_value, avg_data, slide_data;
|
||||
|
||||
u8 gMeas_cnt = 9;
|
||||
ad_sum = min = max = Get_ADC1Value(1);
|
||||
while (gMeas_cnt > 0) {
|
||||
ad_value = Get_ADC1Value(1);
|
||||
ad_sum += ad_value;
|
||||
if (ad_value > max)
|
||||
max = ad_value;
|
||||
if (ad_value < min)
|
||||
min = ad_value;
|
||||
gMeas_cnt--;
|
||||
}
|
||||
ad_sum = ad_sum - max - min;
|
||||
avg_data = ad_sum / 8;
|
||||
//^ Removes the two outliers from the data spread
|
||||
|
||||
rollingAverage[rIndex] = avg_data; //store this result
|
||||
rIndex = (rIndex + 1) % 4; //move the index
|
||||
slide_data = (rollingAverage[0] + rollingAverage[1] + rollingAverage[2]
|
||||
+ rollingAverage[3]) / 4; //get the average
|
||||
return (250 + (3300 * slide_data / 4096) - 750);
|
||||
//(25 + ((10*(33*gSlide_data)/4096)-75));
|
||||
//^ Convert the reading to C
|
||||
|
||||
}
|
||||
|
||||
volatile uint16_t ADC1ConvertedValue[2];
|
||||
//returns the latest reading from ADC1 that was buffered using DMA
|
||||
uint16_t Get_ADC1Value(uint8_t i) {
|
||||
return ADC1ConvertedValue[i];
|
||||
}
|
||||
//This returns the calibrated temperature reading of the iron temp
|
||||
//inputs : calibration value / wether to take a new reading or not
|
||||
uint16_t readIronTemp(uint16_t calibration_temp, uint8_t read) {
|
||||
static uint16_t calTemp = 0;
|
||||
static uint16_t lastVal = 0;
|
||||
|
||||
if (calibration_temp != 0)
|
||||
calTemp = calibration_temp;
|
||||
|
||||
if (read) {
|
||||
lastVal = (readTipTemp() * 1000 + 806 * readSensorTemp()
|
||||
- calTemp * 1000) / 806;
|
||||
|
||||
}
|
||||
|
||||
return lastVal;
|
||||
|
||||
}
|
||||
@@ -1,110 +1,17 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. **********************
|
||||
File Name : Bios.c
|
||||
Version : S100 APP Ver 2.11
|
||||
Description:
|
||||
Author : Celery
|
||||
Data: 2015/07/07
|
||||
History:
|
||||
2015/07/07 ͳһ<CDB3><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
*******************************************************************************/
|
||||
/*
|
||||
* Setup all the basic hardware in the system and handle timer3 tick
|
||||
*/
|
||||
|
||||
#include <Hardware.h>
|
||||
#include <usb_lib.h>
|
||||
#include "APP_Version.h"
|
||||
#include "Bios.h"
|
||||
#include "I2C.h"
|
||||
#include "CTRL.h"
|
||||
|
||||
/******************************************************************************/
|
||||
|
||||
#define ADC1_DR_Address ((u32)0x4001244C)
|
||||
volatile uint32_t gHeat_cnt = 0;
|
||||
|
||||
vu32 gTimeOut, gMs_timeout;
|
||||
volatile u32 gTime[8]; //times for timer storage
|
||||
//^-- gTime is automatically decremented on each firing of timer 2 if >0
|
||||
vu16 ADC1ConvertedValue[2];
|
||||
vu32 gHeat_cnt = 0;
|
||||
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Get_AdcValue
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>ȡADC ת<><D7AA><EFBFBD><EFBFBD>Ķ<EFBFBD><C4B6><EFBFBD>
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:ת<><D7AA><EFBFBD><EFBFBD><EFBFBD>AD
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
u16 Get_AdcValue(u8 i) {
|
||||
return ADC1ConvertedValue[i];
|
||||
}
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Set_HeatingTime
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><><EFBFBD>ü<EFBFBD><C3BC><EFBFBD>ʱ<EFBFBD><CAB1>
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:heating_time <20><><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1>
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Set_HeatingTime(u32 heating_time) {
|
||||
gHeat_cnt = heating_time;
|
||||
}
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Get_HeatingTime
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1>
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:<3A><><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1>
|
||||
*******************************************************************************/
|
||||
u32 Get_HeatingTime(void) {
|
||||
return gHeat_cnt;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description: Init the global count down timers
|
||||
*******************************************************************************/
|
||||
void Init_Gtime(void) {
|
||||
u8 i;
|
||||
|
||||
for (i = 0; i < 8; i++)
|
||||
gTime[i] = 0;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Delay_Ms
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD>
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>ʱ<EFBFBD>ȴ<EFBFBD><C8B4>ĺ<EFBFBD><C4BA><EFBFBD><EFBFBD><EFBFBD>ֵ
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Delay_Ms(u32 ms) {
|
||||
gMs_timeout = ms * 20;
|
||||
while (gMs_timeout)
|
||||
; // {if(Scan_key()!=0)break;}
|
||||
}
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Delay_HalfMs
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:ÿ<><C3BF>λΪ0.5<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>ʱ<EFBFBD>ȴ<EFBFBD><C8B4><EFBFBD>0.5<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Delay_HalfMs(u32 ms) {
|
||||
gMs_timeout = ms * 10;
|
||||
while (gMs_timeout)
|
||||
; // {if(Scan_key()!=0)break;}
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function: USB_Port
|
||||
Description: Enables or disables the usb pins
|
||||
Input: state == ENABLE or DISABLE
|
||||
*******************************************************************************/
|
||||
void USB_Port(u8 state) {
|
||||
USB_DN_LOW();
|
||||
USB_DP_LOW();
|
||||
if (state == DISABLE) {
|
||||
USB_DN_OUT();
|
||||
USB_DP_OUT();
|
||||
} else {
|
||||
USB_DN_EN();
|
||||
USB_DP_EN();
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:RCC_Config
|
||||
Description:Setup the system clocks to use internal HSE to run the system at 48Mhz
|
||||
*******************************************************************************/
|
||||
/*
|
||||
* Setup system clocks to run off internal oscillator at 48Mhz
|
||||
*/
|
||||
void RCC_Config(void) {
|
||||
RCC_DeInit();
|
||||
FLASH_PrefetchBufferCmd(FLASH_PrefetchBuffer_Enable);
|
||||
@@ -123,90 +30,77 @@ void RCC_Config(void) {
|
||||
|
||||
RCC_AHBPeriphClockCmd(
|
||||
RCC_AHBPeriph_SRAM | RCC_AHBPeriph_DMA1 | RCC_AHBPeriph_DMA2 |
|
||||
RCC_AHBPeriph_FLITF, // Enable DMA1 clock ???
|
||||
ENABLE);
|
||||
RCC_AHBPeriph_FLITF, ENABLE);
|
||||
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB |
|
||||
RCC_APB2Periph_ADC1 | RCC_APB2Periph_ADC2, //| RCC_APB2Periph_ADC3, //RCC_APB2Periph_TIM1,
|
||||
ENABLE);
|
||||
RCC_APB2Periph_ADC1 | RCC_APB2Periph_ADC2, ENABLE);
|
||||
RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2 | RCC_APB1Periph_TIM3, ENABLE);
|
||||
|
||||
RCC_USBCLKConfig(RCC_USBCLKSource_PLLCLK_Div1); // USBCLK = 48MHz
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: NVIC_Config
|
||||
Description: Configures the NVIC table in the hardware
|
||||
Input: (tab_offset) the table offset for the NVIC
|
||||
*******************************************************************************/
|
||||
void NVIC_Config(u16 tab_offset) {
|
||||
NVIC_InitTypeDef NVIC_InitStructure;
|
||||
|
||||
RCC_ClocksTypeDef RCC_Clocks;
|
||||
RCC_GetClocksFreq(&RCC_Clocks);
|
||||
SysTick_Config(RCC_Clocks.HCLK_Frequency / 1000); //Enable the systick timer at 1ms
|
||||
}
|
||||
/*
|
||||
* Shift the NVIC (Interrupt table) location relative to flash start
|
||||
*/
|
||||
void NVIC_Config(u16 tab_offset) {
|
||||
NVIC_SetVectorTable(NVIC_VectTab_FLASH, tab_offset);
|
||||
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
|
||||
NVIC_InitStructure.NVIC_IRQChannel = USB_LP_CAN1_RX0_IRQn;
|
||||
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2;
|
||||
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0;
|
||||
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
|
||||
NVIC_Init(&NVIC_InitStructure);
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:GPIO_Config
|
||||
Description: Configures all the GPIO into required states
|
||||
*******************************************************************************/
|
||||
/*
|
||||
* Setup the GPIO
|
||||
*/
|
||||
void GPIO_Config(void) {
|
||||
GPIO_InitTypeDef GPIO_InitStructure;
|
||||
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB | RCC_APB2Periph_AFIO, ENABLE); // GPIOB & AFIO
|
||||
|
||||
GPIOA_OUTPUT()
|
||||
;
|
||||
GPIOA_L_DEF()
|
||||
;
|
||||
GPIOA_H_DEF()
|
||||
;
|
||||
GPIO_PinRemapConfig(GPIO_Remap_SWJ_NoJTRST, ENABLE);
|
||||
GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable, ENABLE);
|
||||
|
||||
GPIOB_OUTPUT()
|
||||
;
|
||||
GPIOB_L_DEF()
|
||||
;
|
||||
GPIOB_H_DEF()
|
||||
;
|
||||
|
||||
//------ PA7 TMP36 Analog input ----------------------------------------//
|
||||
//------ PA7 TMP36 Analog input ----------------------------------------//
|
||||
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AIN;
|
||||
GPIO_Init(GPIOA, &GPIO_InitStructure);
|
||||
|
||||
//------ OLED_RST_PIN(PB9) ------------------------------------------------------------//
|
||||
//------ OLED_RST_PIN(PB9) ---------------------------------------------//
|
||||
GPIO_InitStructure.GPIO_Pin = OLED_RST_PIN;
|
||||
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
|
||||
GPIO_Init(GPIOB, &GPIO_InitStructure);
|
||||
GPIO_Init(GPIOA, &GPIO_InitStructure);
|
||||
|
||||
//------- Heat_Pin - Iron enable output PB4--------------------------------------------------------//
|
||||
GPIO_PinRemapConfig(GPIO_Remap_SWJ_NoJTRST, ENABLE); //Disable PB4=JNTRST
|
||||
//------- Heat_Pin - Iron enable output PB4-----------------------------//
|
||||
|
||||
GPIO_InitStructure.GPIO_Pin = HEAT_PIN;
|
||||
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
|
||||
GPIO_Init(GPIOB, &GPIO_InitStructure);
|
||||
|
||||
//------ PB0 Iron temp input---------------------------------------//
|
||||
//----------- PB0 Iron temp input---------------------------------------//
|
||||
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AIN;
|
||||
GPIO_Init(GPIOB, &GPIO_InitStructure);
|
||||
|
||||
//---------- INPUT Voltage Detection Pin VB PB1(Ai9) ---------------------------------------//
|
||||
//---------- INPUT Voltage Detection Pin VB PB1(Ai9) -------------------//
|
||||
GPIO_InitStructure.GPIO_Pin = VB_PIN;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AIN;
|
||||
GPIO_Init(GPIOB, &GPIO_InitStructure);
|
||||
|
||||
//-------- K1 = PA9, K2 = PA6 ----------------------------------------------------------//
|
||||
//-------- K1 = PA9, K2 = PA6 ------------------------------------------//
|
||||
GPIO_InitStructure.GPIO_Pin = KEY1_PIN | KEY2_PIN;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;
|
||||
GPIO_Init(GPIOA, &GPIO_InitStructure);
|
||||
|
||||
//--------INT 1 == PB5 -------------------------------------------------//
|
||||
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_5;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;//pullup just in case something resets the accel
|
||||
GPIO_Init(GPIOB, &GPIO_InitStructure);
|
||||
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Adc_Init
|
||||
Description:Enable the ADC's and setup the DMA as well to automatically read them to system ram.
|
||||
*******************************************************************************/
|
||||
/*
|
||||
* Init the ADC's
|
||||
* Setup ADC1 to read via DMA to device ram automatically
|
||||
*/
|
||||
void Adc_Init(void) {
|
||||
u32 timeout = 10 * 0x1000;
|
||||
ADC_InitTypeDef ADC_InitStructure;
|
||||
@@ -220,7 +114,8 @@ void Adc_Init(void) {
|
||||
DMA_InitStructure.DMA_BufferSize = 2;
|
||||
DMA_InitStructure.DMA_PeripheralInc = DMA_PeripheralInc_Disable;
|
||||
DMA_InitStructure.DMA_MemoryInc = DMA_MemoryInc_Enable;
|
||||
DMA_InitStructure.DMA_PeripheralDataSize = DMA_PeripheralDataSize_HalfWord;
|
||||
DMA_InitStructure.DMA_PeripheralDataSize =
|
||||
DMA_PeripheralDataSize_HalfWord;
|
||||
DMA_InitStructure.DMA_MemoryDataSize = DMA_MemoryDataSize_HalfWord;
|
||||
DMA_InitStructure.DMA_Mode = DMA_Mode_Circular;
|
||||
DMA_InitStructure.DMA_Priority = DMA_Priority_High;
|
||||
@@ -250,9 +145,12 @@ void Adc_Init(void) {
|
||||
ADC_Init(ADC2, &ADC_InitStructure);
|
||||
|
||||
// ADC1,2 regular channel7 channel9 and channel8 configuration ----------//
|
||||
ADC_RegularChannelConfig(ADC1, ADC_Channel_7, 2, ADC_SampleTime_239Cycles5); //28 or 55
|
||||
ADC_RegularChannelConfig(ADC1, ADC_Channel_8, 1, ADC_SampleTime_239Cycles5); //28 or 55
|
||||
ADC_RegularChannelConfig(ADC2, ADC_Channel_9, 1, ADC_SampleTime_55Cycles5); //28 or 55
|
||||
ADC_RegularChannelConfig(ADC1, ADC_Channel_7, 2,
|
||||
ADC_SampleTime_239Cycles5); //28 or 55
|
||||
ADC_RegularChannelConfig(ADC1, ADC_Channel_8, 1,
|
||||
ADC_SampleTime_239Cycles5); //28 or 55
|
||||
ADC_RegularChannelConfig(ADC2, ADC_Channel_9, 1,
|
||||
ADC_SampleTime_55Cycles5); //28 or 55
|
||||
|
||||
/* Enable ADC1 DMA */
|
||||
ADC_DMACmd(ADC1, ENABLE);
|
||||
@@ -275,43 +173,19 @@ void Adc_Init(void) {
|
||||
ADC_SoftwareStartConvCmd(ADC2, ENABLE);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description: Setup Timer2 to fire every 10ms
|
||||
*******************************************************************************/
|
||||
void Init_Timer2(void) {
|
||||
NVIC_InitTypeDef NVIC_InitStructure;
|
||||
TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
|
||||
|
||||
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_0);
|
||||
|
||||
TIM_TimeBaseStructure.TIM_Prescaler = 48 - 1; // (48MHz)/48 = 1MHz
|
||||
TIM_TimeBaseStructure.TIM_Period = 10000 - 1; // Interrupt per 10mS
|
||||
TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;
|
||||
TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
|
||||
TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure);
|
||||
TIM_ARRPreloadConfig(TIM2, ENABLE);
|
||||
TIM_ITConfig(TIM2, TIM_IT_Update, ENABLE);
|
||||
TIM_Cmd(TIM2, ENABLE);
|
||||
|
||||
NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn;
|
||||
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;
|
||||
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;
|
||||
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
|
||||
NVIC_Init(&NVIC_InitStructure);
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description: Init Timer3 to fire every 50us to be used to control the irons software PWM
|
||||
*******************************************************************************/
|
||||
/*
|
||||
* Init Timer3 to fire every 50us to be used to control the irons software PWM
|
||||
* This needs to be really fast as there is a cap used between this and the driver circuitry
|
||||
* That prevents a stuck mcu heating the tip
|
||||
*/
|
||||
void Init_Timer3(void) {
|
||||
NVIC_InitTypeDef NVIC_InitStructure;
|
||||
TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
|
||||
|
||||
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_0);
|
||||
|
||||
TIM_TimeBaseStructure.TIM_Prescaler = 48 - 1; //(48MHz)/48 = 1MHz
|
||||
TIM_TimeBaseStructure.TIM_Period = 50 - 1; // Interrupt per 50us
|
||||
TIM_TimeBaseStructure.TIM_Prescaler = 48 - 1; //(48MHz)/48 = 1MHz
|
||||
TIM_TimeBaseStructure.TIM_Period = 50 - 1; // Interrupt per 50us
|
||||
TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV2;
|
||||
TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;
|
||||
TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure);
|
||||
@@ -325,50 +199,74 @@ void Init_Timer3(void) {
|
||||
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
|
||||
NVIC_Init(&NVIC_InitStructure);
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:TIM2_ISR
|
||||
Description:Handles Timer 2 tick. (10mS)
|
||||
Automatically decrements all >0 values in gTime.
|
||||
Also reads the buttons every 4 ticks
|
||||
*******************************************************************************/
|
||||
void TIM2_ISR(void) {
|
||||
static u8 buttonReadDivider;
|
||||
//We want to enable the EXTI IRQ for the two buttons on PA6 and PA9
|
||||
void Init_EXTI(void) {
|
||||
EXTI_InitTypeDef EXTI_InitStructure;
|
||||
NVIC_InitTypeDef NVIC_InitStructure;
|
||||
|
||||
TIM_ClearITPendingBit(TIM2, TIM_IT_Update); // Clear interrupt flag
|
||||
for (u8 i = 0; i < 8; i++)
|
||||
if (gTime[i] > 0)
|
||||
gTime[i]--;
|
||||
GPIO_EXTILineConfig(GPIO_PortSourceGPIOA,
|
||||
GPIO_PinSource6 | GPIO_PinSource9);
|
||||
|
||||
GPIO_EXTILineConfig(GPIO_PortSourceGPIOB,
|
||||
GPIO_PinSource5); //PB5 == accelerometer
|
||||
|
||||
/* Configure EXTI5/6/9 line */
|
||||
EXTI_InitStructure.EXTI_Line = EXTI_Line5 | EXTI_Line6 | EXTI_Line9;
|
||||
EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt;
|
||||
EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Rising_Falling; //trigger on up and down
|
||||
EXTI_InitStructure.EXTI_LineCmd = ENABLE;
|
||||
EXTI_Init(&EXTI_InitStructure);
|
||||
|
||||
/* Enable and set EXTI9_5 Interrupt to the lowest priority */
|
||||
NVIC_InitStructure.NVIC_IRQChannel = EXTI9_5_IRQn;
|
||||
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0x0F;
|
||||
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0x0F;
|
||||
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
|
||||
NVIC_Init(&NVIC_InitStructure);
|
||||
|
||||
if (++buttonReadDivider % 4 == 0)
|
||||
Scan_Key();
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: TIM3_ISR
|
||||
Description:Sets the output pin as appropriate
|
||||
If the Heat_cnt >0 then heater on, otherwise off.
|
||||
*******************************************************************************/
|
||||
//Start the system watchdog with a timeout specified
|
||||
//Note you cannot turn this off once you turn it on
|
||||
void Start_Watchdog(uint32_t ms) {
|
||||
IWDG_WriteAccessCmd(IWDG_WriteAccess_Enable);
|
||||
|
||||
/* IWDG counter clock: 40KHz(LSI) / 32 = 1.25 KHz (min:0.8ms -- max:3276.8ms */
|
||||
IWDG_SetPrescaler(IWDG_Prescaler_32);
|
||||
|
||||
/* Set counter reload value to XXms */
|
||||
IWDG_SetReload(ms * 10 / 8);
|
||||
|
||||
/* Reload IWDG counter */
|
||||
IWDG_ReloadCounter();
|
||||
|
||||
/* Enable IWDG (the LSI oscillator will be enabled by hardware) */
|
||||
IWDG_Enable();
|
||||
}
|
||||
|
||||
//Reset the system watchdog
|
||||
void Clear_Watchdog(void) {
|
||||
IWDG_ReloadCounter();
|
||||
}
|
||||
|
||||
//TIM3_ISR handles the tick of the timer 3 IRQ
|
||||
void TIM3_ISR(void) {
|
||||
volatile static u8 heat_flag = 0;
|
||||
//heat flag == used to make the pin toggle
|
||||
//As the output is passed through a cap, the iron is on whilever we provide a square wave drive output
|
||||
|
||||
TIM_ClearITPendingBit(TIM3, TIM_IT_Update); // Clear interrupt flag
|
||||
|
||||
if (gTimeOut > 0)
|
||||
gTimeOut--;
|
||||
if (gMs_timeout > 0)
|
||||
gMs_timeout--;
|
||||
TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
|
||||
// Clear interrupt flag
|
||||
|
||||
if (gHeat_cnt > 0) {
|
||||
gHeat_cnt--;
|
||||
--gHeat_cnt;
|
||||
if (heat_flag)
|
||||
HEAT_OFF();
|
||||
HEAT_OFF(); //write the pin off
|
||||
else
|
||||
HEAT_ON();
|
||||
|
||||
heat_flag = ~heat_flag;
|
||||
}
|
||||
if (gHeat_cnt == 0) {
|
||||
HEAT_OFF();
|
||||
HEAT_ON(); //write the pin on
|
||||
heat_flag = !heat_flag;
|
||||
} else {
|
||||
HEAT_OFF(); //set the pin low for measurements
|
||||
heat_flag = 0;
|
||||
}
|
||||
|
||||
}
|
||||
/******************************** END OF FILE *********************************/
|
||||
|
||||
@@ -1,450 +0,0 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. **********************
|
||||
File Name : CTRL.c
|
||||
Version : S100 APP Ver 2.11
|
||||
Description:
|
||||
Author : Celery
|
||||
Data: 2015/08/03
|
||||
History:
|
||||
2015/07/07 ͳһ<CDB3><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
2015/08/03 <20>Ż<EFBFBD><C5BB>ƶ<EFBFBD><C6B6>ж<EFBFBD>
|
||||
*******************************************************************************/
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include "CTRL.h"
|
||||
#include "Bios.h"
|
||||
#include "UI.h"
|
||||
#include "Hardware.h"
|
||||
#include "S100V0_1.h"
|
||||
#include "Disk.h"
|
||||
#include "MMA8652FC.h"
|
||||
|
||||
#define HEATINGCYCLE 30
|
||||
/******************************************************************************/
|
||||
DEVICE_INFO_SYS device_info;
|
||||
/******************************************************************************/
|
||||
|
||||
u8 gCtrl_status = 1;
|
||||
//^ System current status / operating mode.
|
||||
u16 gHt_flag = 0;
|
||||
vs16 gTemp_data = 250; //
|
||||
s16 gPrev_temp = 250; //
|
||||
u8 gIs_restartkey = 0; //
|
||||
u8 gPre_status = 1; //
|
||||
|
||||
const DEVICE_INFO_SYS info_def = { "2.13", //Ver
|
||||
2000, //T_Standby; // 200C=1800 2520
|
||||
3000, // T_Work; // 350C=3362,
|
||||
100, //T_Step;
|
||||
3 * 60 * 100, //Wait_Time; //3*60*100 3 minutes
|
||||
6 * 60 * 100 // Idle_Time; //6*60*100 6 minutes
|
||||
};
|
||||
struct _pid {
|
||||
s16 settemp; //Current ideal setpoint for the temp
|
||||
s16 actualtemp; //Actual current temp of the tip
|
||||
s16 err; //Error term
|
||||
s16 err_last; //last error term
|
||||
s32 ht_time; //
|
||||
u16 kp, ki, kd; //Constants for the PID Controller
|
||||
s32 integral; //
|
||||
} pid;
|
||||
|
||||
/*******************************************************************************
|
||||
Function: Get_Ctrl_Status
|
||||
Description: Returns the current operating Mode
|
||||
Input:Void
|
||||
Output:Current System Status
|
||||
*******************************************************************************/
|
||||
u8 Get_CtrlStatus(void) {
|
||||
return gCtrl_status;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Set_CtrlStatus
|
||||
Description: Set the current operating Mode
|
||||
Input:status uint8_t
|
||||
Output:Void
|
||||
*******************************************************************************/
|
||||
void Set_CtrlStatus(u8 status) {
|
||||
gCtrl_status = status;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Set_PrevTemp
|
||||
Description:Set the previous temp record for the PID
|
||||
Input:Previous Temp (int16_t)
|
||||
Output:Void
|
||||
*******************************************************************************/
|
||||
void Set_PrevTemp(s16 temp) {
|
||||
gPrev_temp = temp;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function: Get_HtFlag
|
||||
Description:
|
||||
Input:Void
|
||||
Output:Void
|
||||
|
||||
*******************************************************************************/
|
||||
u16 Get_HtFlag(void) {
|
||||
return gHt_flag;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:Get_TempVal
|
||||
Description:
|
||||
Input:Void
|
||||
Output:Void
|
||||
*******************************************************************************/
|
||||
s16 Get_TempVal(void) {
|
||||
return gTemp_data;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:System_Init
|
||||
Description:Init the device info to be a known start value (as defined at top of CTRL.c)
|
||||
Input:Void
|
||||
Output:Void
|
||||
*******************************************************************************/
|
||||
void System_Init(void) {
|
||||
memcpy((void*) &device_info, (void*) &info_def, sizeof(device_info));
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:Pid_Init
|
||||
Description:Inits the PID values to defaults (0 usually)
|
||||
Input:Void
|
||||
Output:Void
|
||||
*******************************************************************************/
|
||||
void Pid_Init(void) {
|
||||
pid.settemp = 0;
|
||||
pid.actualtemp = 0;
|
||||
pid.err = 0;
|
||||
pid.err_last = 0;
|
||||
pid.integral = 0;
|
||||
pid.ht_time = 0;
|
||||
pid.kp = 15;
|
||||
pid.ki = 2;
|
||||
pid.kd = 1;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:Pid_Realize
|
||||
Description: Calculates the next heating value using the PID algorithum
|
||||
Input:Current temp from the tip
|
||||
Output:
|
||||
*******************************************************************************/
|
||||
u16 Pid_Realize(s16 temp) {
|
||||
u8 index = 0, index1 = 1;
|
||||
s16 d_err = 0;
|
||||
|
||||
pid.actualtemp = temp;
|
||||
pid.err = pid.settemp - pid.actualtemp; //
|
||||
|
||||
if (pid.err >= 500)
|
||||
index = 0;
|
||||
else {
|
||||
index = 1;
|
||||
pid.integral += pid.err; //
|
||||
}
|
||||
////////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
if (pid.settemp < pid.actualtemp) {
|
||||
d_err = pid.actualtemp - pid.settemp;
|
||||
if (d_err > 20) {
|
||||
pid.integral = 0; //
|
||||
index1 = 0;
|
||||
index = 0;
|
||||
}
|
||||
}
|
||||
////////////////////////////////////////////////////////////////////////////////
|
||||
if (pid.err <= 30)
|
||||
index1 = 0;
|
||||
else
|
||||
index1 = 1;
|
||||
pid.ht_time = pid.kp * pid.err + pid.ki * index * pid.integral
|
||||
+ pid.kd * (pid.err - pid.err_last) * index1;
|
||||
pid.err_last = pid.err;
|
||||
|
||||
if (pid.ht_time <= 0)
|
||||
pid.ht_time = 0;
|
||||
else if (pid.ht_time > 30 * 200)
|
||||
pid.ht_time = 30 * 200;
|
||||
|
||||
return pid.ht_time;
|
||||
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:Heating_Time
|
||||
Description:Calcuates the on time for the heating element
|
||||
Input: (temp) current Tip Temp, (wk_temp) current ideal setpoint temp
|
||||
Output: The ON time for the heater element
|
||||
*******************************************************************************/
|
||||
u32 Heating_Time(s16 temp, s16 wk_temp) {
|
||||
u32 heat_timecnt;
|
||||
|
||||
pid.settemp = wk_temp;
|
||||
if (wk_temp > temp) {
|
||||
if (wk_temp - temp >= 18)
|
||||
gHt_flag = 0; //<2F><><EFBFBD><EFBFBD>
|
||||
else
|
||||
gHt_flag = 2; //<2F><><EFBFBD><EFBFBD>
|
||||
} else {
|
||||
if (temp - wk_temp <= 18)
|
||||
gHt_flag = 2; //<2F><><EFBFBD><EFBFBD>
|
||||
else
|
||||
gHt_flag = 1; //<2F><><EFBFBD><EFBFBD>
|
||||
}
|
||||
|
||||
heat_timecnt = Pid_Realize(temp); //Sub_data * 1000;
|
||||
|
||||
return heat_timecnt;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:Status_Tran
|
||||
Description: Handles the current status of the unit, and task selection
|
||||
Basically this is called in main() repeatedly
|
||||
Input:Void
|
||||
Output:Void
|
||||
*******************************************************************************/
|
||||
void Status_Tran(void) //
|
||||
{
|
||||
static u16 init_waitingtime = 0; //<2F><>ʼ<EFBFBD><CABC><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD>־λ: 0=> δ<><CEB4>ʼ<EFBFBD><CABC>,1=><3E>ѳ<EFBFBD>ʼ<EFBFBD><CABC>
|
||||
static u8 back_prestatus = 0;
|
||||
s16 heat_timecnt = 0, wk_temp;
|
||||
u16 mma_active;
|
||||
|
||||
switch (Get_CtrlStatus()) {
|
||||
case IDLE:
|
||||
switch (Get_gKey()) { //Read current switch positions
|
||||
case KEY_V1: //If V1 key is pressed
|
||||
if (gIs_restartkey != 1) { //check we are not in a soft restart situation
|
||||
if (Read_Vb(1) < 4) { //Read that the input voltage is acceptable??
|
||||
Set_CtrlStatus(TEMP_CTR); //Set to temperature controlled mode (Aka soldering mode)
|
||||
init_waitingtime = 0; //Initialize the wait count to 0
|
||||
TEMPSHOW_TIMER= 0; //Initialize the timer to 0
|
||||
UI_TIMER= 0;
|
||||
G6_TIMER= 0;
|
||||
}
|
||||
}
|
||||
break;
|
||||
case KEY_V2: //check if V2 key is pressed
|
||||
if(gIs_restartkey != 1) { //check this is not a soft restart situation
|
||||
Set_CtrlStatus(THERMOMETER);//Change system to Thermometer mode instead (ie reading temp only, no drive)
|
||||
UI_TIMER = 0;
|
||||
Set_LongKeyFlag(1);//Set the long key pressed flag??
|
||||
}
|
||||
break;
|
||||
case KEY_CN|KEY_V3: //If A&B pressed at the same time, no action
|
||||
break;
|
||||
}
|
||||
if(gIs_restartkey && (KD_TIMER == 0)) { //This is a soft restart situation instead
|
||||
gIs_restartkey = 0;//reset the flag for soft restart
|
||||
Set_gKey(NO_KEY);//reset keys pressed
|
||||
}
|
||||
if(Read_Vb(1) == 0) { //Invalid voltage, I think this means no input power detected
|
||||
if(Get_UpdataFlag() == 1) Set_UpdataFlag(0);
|
||||
Set_CtrlStatus(ALARM);
|
||||
}
|
||||
if(gPre_status != WAIT && gPre_status != IDLE) { //System has been left alone, turn off screen to stop burn in
|
||||
G6_TIMER = device_info.idle_time;
|
||||
Set_gKey(NO_KEY);
|
||||
gPre_status = IDLE;
|
||||
}
|
||||
break;
|
||||
case TEMP_CTR: //We are in soldering mode
|
||||
switch(Get_gKey()) { //switch on the pressed key
|
||||
case KEY_CN|KEY_V1:
|
||||
case KEY_CN|KEY_V2://if either key long pressed
|
||||
Set_HeatingTime(0);//turn off heater
|
||||
Set_CtrlStatus(TEMP_SET);//Goto temperature set mode
|
||||
HEATING_TIMER = 0;//reset heating timer
|
||||
EFFECTIVE_KEY_TIMER = 500;
|
||||
break;
|
||||
case KEY_CN|KEY_V3://Both keys pressed
|
||||
Set_HeatingTime(0);//Stop the heater
|
||||
Set_LongKeyFlag(0);//Reset the long key press flag
|
||||
Set_CtrlStatus(IDLE);//Change the system back to IDLE state (stop soldering)
|
||||
gPre_status = TEMP_CTR;//Set previous status
|
||||
gIs_restartkey = 1;
|
||||
KD_TIMER = 50;//
|
||||
break;
|
||||
}
|
||||
|
||||
if(Read_Vb(1) >= 4) { //Check input voltage is in the acceptable range
|
||||
Set_HeatingTime(0);//Turn of heater as we are out of range
|
||||
Set_LongKeyFlag(0);//reset key flag
|
||||
Set_CtrlStatus(IDLE);//reset to IDLE state
|
||||
gPre_status = TEMP_CTR;//set previous state
|
||||
gIs_restartkey = 1;
|
||||
KD_TIMER = 50;//
|
||||
}
|
||||
|
||||
wk_temp = device_info.t_work; //update setpoint temp from the struct
|
||||
if(HEATING_TIMER == 0) {
|
||||
gTemp_data = Get_Temp(wk_temp);
|
||||
heat_timecnt = Heating_Time(gTemp_data,wk_temp); //Calculate the on time for the heating cycle
|
||||
Set_HeatingTime(heat_timecnt);//set the on time for the heating cycle
|
||||
HEATING_TIMER = HEATINGCYCLE;
|
||||
}
|
||||
|
||||
if(Get_HeatingTime() == 0) { //If calcuated heater time is 0 stop the timer ?
|
||||
HEATING_TIMER = 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* The logic here is :
|
||||
* If the device is moving then disarm the timer and mark it as needed a re-init
|
||||
* else check if the timer needs init, if it does set it up and exit
|
||||
* if the timer does not need init, then check if the timer has expired (its a count down)
|
||||
* If the timer has expired goto wait state instead and shutdown iron
|
||||
*/
|
||||
mma_active = Get_MmaShift(); //check the accelerometer for movement
|
||||
if(mma_active == 0) { //MMA_active = 0 ==> static ,MMA_active = 1 ==>move
|
||||
if(init_waitingtime == 0) { //If the waiting countdown timer is not initialized
|
||||
init_waitingtime = 1;//we initialize it and set this <- flag.
|
||||
ENTER_WAIT_TIMER = device_info.wait_time;
|
||||
}
|
||||
if((init_waitingtime != 0) && (ENTER_WAIT_TIMER == 0)) { //if timeout has been initalized and enter_wait_timer has reached 0
|
||||
gHt_flag = 0;//reset heating flags
|
||||
UI_TIMER = 0;//reset ui timers
|
||||
Set_HeatingTime(0);//turn off the soldering iron
|
||||
Set_gKey(0);//clear keys
|
||||
G6_TIMER = device_info.idle_time;//set the device to idle timer move
|
||||
Set_CtrlStatus(WAIT);//Set system mode to waiting for movement
|
||||
}
|
||||
} else { //The iron is moving
|
||||
init_waitingtime = 0;//mark the waiting timer for needing reset if movement stops again
|
||||
}
|
||||
|
||||
if(Get_AlarmType() > NORMAL_TEMP) { //
|
||||
if(Get_UpdataFlag() == 1) Set_UpdataFlag(0);
|
||||
Set_CtrlStatus(ALARM);//Change to alarm state
|
||||
}
|
||||
break;
|
||||
|
||||
case WAIT:
|
||||
//This mode (WAIT) occures when the iron has been idling on a desk for too long (ie someone forgot it was left on)
|
||||
//In this state we drop to a lower, safer temp and wait for movement or button push to wake up to operating temp again
|
||||
wk_temp = device_info.t_standby;
|
||||
if(device_info.t_standby > device_info.t_work) {
|
||||
//Check if the set temp was greater than the idle temp, if it was we set the idle temp to the set temp
|
||||
//This is done to avoid standby going to a higher temp
|
||||
wk_temp = device_info.t_work;
|
||||
}
|
||||
//if the heating timer has expired, update the readings
|
||||
if(HEATING_TIMER == 0) {
|
||||
gTemp_data = Get_Temp(wk_temp); //read the tip temp
|
||||
heat_timecnt = Heating_Time(gTemp_data,wk_temp);//calculate the new heating timer value from temps
|
||||
Set_HeatingTime(heat_timecnt);//apply the new heating timer
|
||||
HEATING_TIMER = 30;//set update rate for heating_timer
|
||||
}
|
||||
|
||||
if(Read_Vb(1) >= 4) { //If the input voltage is not valid
|
||||
Set_HeatingTime(0);//turn off heater
|
||||
Set_LongKeyFlag(0);//reset key press flag
|
||||
Set_CtrlStatus(IDLE);//goto IDLE state
|
||||
G6_TIMER = device_info.idle_time;
|
||||
gPre_status = WAIT;//set previous state
|
||||
gIs_restartkey = 1;
|
||||
KD_TIMER = 50;//
|
||||
}
|
||||
|
||||
if(G6_TIMER == 0) { //
|
||||
Set_HeatingTime(0);
|
||||
Set_LongKeyFlag(0);
|
||||
gIs_restartkey = 1;
|
||||
KD_TIMER = 200;//
|
||||
gPre_status = WAIT;
|
||||
Set_CtrlStatus(IDLE);
|
||||
}
|
||||
|
||||
//If movement has occurred OR a key has been pressed -> Wakeup back to soldering
|
||||
mma_active = Get_MmaShift();//read accelerometer
|
||||
if(mma_active == 1 || Get_gKey() != 0) {
|
||||
UI_TIMER = 0; //reset the un-needed timers
|
||||
G6_TIMER = 0;
|
||||
init_waitingtime = 0;
|
||||
Set_CtrlStatus(TEMP_CTR);//Go back to soldering iron mode
|
||||
}
|
||||
|
||||
if(Get_AlarmType() > NORMAL_TEMP) { //If an alarm has occurred??
|
||||
if(Get_UpdataFlag() == 1) Set_UpdataFlag(0);
|
||||
Set_CtrlStatus(ALARM);//goto alarm error state
|
||||
}
|
||||
break;
|
||||
|
||||
case TEMP_SET: //We are in the setting soldering iron temp mode
|
||||
if(EFFECTIVE_KEY_TIMER == 0) {
|
||||
gCalib_flag = 1;
|
||||
Disk_BuffInit();
|
||||
Config_Analysis(); //
|
||||
gCalib_flag = 0;
|
||||
Set_CtrlStatus(TEMP_CTR);//return to soldering mode
|
||||
TEMPSHOW_TIMER = 0;//turn off the timer
|
||||
}
|
||||
break;
|
||||
|
||||
case THERMOMETER: //we are measuring the tip temp without applying any power
|
||||
if(KD_TIMER > 0) {
|
||||
Set_gKey(NO_KEY);
|
||||
break;
|
||||
}
|
||||
|
||||
switch(Get_gKey()) {
|
||||
case KEY_CN|KEY_V1:
|
||||
case KEY_CN|KEY_V2:
|
||||
back_prestatus = 1;
|
||||
break;
|
||||
case KEY_CN|KEY_V3:
|
||||
Zero_Calibration(); //Calibrate the temperature (i think??)
|
||||
if(Get_CalFlag() == 1) {
|
||||
Disk_BuffInit();
|
||||
Config_Analysis(); // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>U<EFBFBD><55>
|
||||
}
|
||||
KD_TIMER = 200; //20150717 <20><EFBFBD>
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
if(back_prestatus == 1) { //we are exiting
|
||||
back_prestatus = 0;//clear flag
|
||||
Set_HeatingTime(0);//turn off heater? (not sure why this is done again)
|
||||
Set_CtrlStatus(IDLE);//Goto IDLE state
|
||||
gPre_status = THERMOMETER;//set previous state
|
||||
gIs_restartkey = 1;//signal soft restart required as we may have done a calibration
|
||||
Set_LongKeyFlag(0);//reset long key hold flag
|
||||
KD_TIMER = 50;//
|
||||
}
|
||||
break;
|
||||
case ALARM: //An error has occured so we are in alarm state
|
||||
switch(Get_AlarmType()) {
|
||||
case HIGH_TEMP: //over temp condition
|
||||
case SEN_ERR://sensor reading error
|
||||
wk_temp = device_info.t_work;
|
||||
gTemp_data = Get_Temp(wk_temp);
|
||||
if(Get_AlarmType() == NORMAL_TEMP) {
|
||||
Set_CtrlStatus(TEMP_CTR);
|
||||
Set_UpdataFlag(0);
|
||||
}
|
||||
break;
|
||||
case HIGH_VOLTAGE: //over voltage
|
||||
case LOW_VOLTAGE://under voltage
|
||||
if(Read_Vb(1) >= 1 && Read_Vb(1) <= 3) {
|
||||
Set_HeatingTime(0); //turn off heater
|
||||
Set_LongKeyFlag(0);//reset key flag
|
||||
gIs_restartkey = 1;
|
||||
UI_TIMER = 2;// 2<><32>
|
||||
gPre_status = THERMOMETER;
|
||||
Set_CtrlStatus(IDLE);
|
||||
}
|
||||
break;
|
||||
}
|
||||
//V-- No idea what this does yet.. At all.. since it will always be skipped..
|
||||
if(Get_HeatingTime != 0) {
|
||||
Set_HeatingTime(0); //<2F><><EFBFBD><EFBFBD>ֹͣ<CDA3><D6B9><EFBFBD><EFBFBD>
|
||||
HEAT_OFF();
|
||||
}
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/******************************** END OF FILE *********************************/
|
||||
@@ -1,773 +0,0 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. **********************
|
||||
File Name : Disk.c
|
||||
Version : S100 APP Ver 2.11
|
||||
Description:
|
||||
Author : Celery
|
||||
Data: 2015/07/07
|
||||
History:
|
||||
2016/09/13 Ben V. Brown English notation/comments
|
||||
2015/07/07
|
||||
*******************************************************************************/
|
||||
#include <string.h>
|
||||
#include <stdio.h>
|
||||
#include "APP_Version.h"
|
||||
#include "Disk.h"
|
||||
#include "Bios.h"
|
||||
#include "Flash.h"
|
||||
#include "Oled.h"
|
||||
#include "UI.h"
|
||||
#include "CTRL.h"
|
||||
#include "Hardware.h"
|
||||
|
||||
#define Delay_mS Delay_Ms
|
||||
void Disk_SecWrite(u8* pBuffer, u32 DiskAddr);
|
||||
void Disk_SecRead(u8* pBuffer, u32 DiskAddr);
|
||||
void Soft_Delay(void);
|
||||
//Hard coded boot sector for the virtual device
|
||||
const uint8_t BOOT_SEC[512] = { 0xEB, 0x3C, 0x90, 0x4D, 0x53, 0x44, 0x4F, 0x53,
|
||||
0x35, 0x2E, 0x30, 0x00, 0x02, 0x01, 0x08, 0x00, 0x02, 0x00, 0x02, 0x50,
|
||||
0x00, 0xF8, 0x0c, 0x00, 0x01, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x29, 0xA2, 0x98, 0xE4, 0x6C, 0x4E,
|
||||
0x4F, 0x20, 0x4E, 0x41, 0x4D, 0x45, 0x20, 0x20, 0x20, 0x20, 0x46, 0x41,
|
||||
0x54, 0x31, 0x32, 0x20, 0x20, 0x20, 0x33, 0xC9, 0x8E, 0xD1, 0xBC, 0xF0,
|
||||
0x7B, 0x8E, 0xD9, 0xB8, 0x00, 0x20, 0x8E, 0xC0, 0xFC, 0xBD, 0x00, 0x7C,
|
||||
0x38, 0x4E, 0x24, 0x7D, 0x24, 0x8B, 0xC1, 0x99, 0xE8, 0x3C, 0x01, 0x72,
|
||||
0x1C, 0x83, 0xEB, 0x3A, 0x66, 0xA1, 0x1C, 0x7C, 0x26, 0x66, 0x3B, 0x07,
|
||||
0x26, 0x8A, 0x57, 0xFC, 0x75, 0x06, 0x80, 0xCA, 0x02, 0x88, 0x56, 0x02,
|
||||
0x80, 0xC3, 0x10, 0x73, 0xEB, 0x33, 0xC9, 0x8A, 0x46, 0x10, 0x98, 0xF7,
|
||||
0x66, 0x16, 0x03, 0x46, 0x1C, 0x13, 0x56, 0x1E, 0x03, 0x46, 0x0E, 0x13,
|
||||
0xD1, 0x8B, 0x76, 0x11, 0x60, 0x89, 0x46, 0xFC, 0x89, 0x56, 0xFE, 0xB8,
|
||||
0x20, 0x00, 0xF7, 0xE6, 0x8B, 0x5E, 0x0B, 0x03, 0xC3, 0x48, 0xF7, 0xF3,
|
||||
0x01, 0x46, 0xFC, 0x11, 0x4E, 0xFE, 0x61, 0xBF, 0x00, 0x00, 0xE8, 0xE6,
|
||||
0x00, 0x72, 0x39, 0x26, 0x38, 0x2D, 0x74, 0x17, 0x60, 0xB1, 0x0B, 0xBE,
|
||||
0xA1, 0x7D, 0xF3, 0xA6, 0x61, 0x74, 0x32, 0x4E, 0x74, 0x09, 0x83, 0xC7,
|
||||
0x20, 0x3B, 0xFB, 0x72, 0xE6, 0xEB, 0xDC, 0xA0, 0xFB, 0x7D, 0xB4, 0x7D,
|
||||
0x8B, 0xF0, 0xAC, 0x98, 0x40, 0x74, 0x0C, 0x48, 0x74, 0x13, 0xB4, 0x0E,
|
||||
0xBB, 0x07, 0x00, 0xCD, 0x10, 0xEB, 0xEF, 0xA0, 0xFD, 0x7D, 0xEB, 0xE6,
|
||||
0xA0, 0xFC, 0x7D, 0xEB, 0xE1, 0xCD, 0x16, 0xCD, 0x19, 0x26, 0x8B, 0x55,
|
||||
0x1A, 0x52, 0xB0, 0x01, 0xBB, 0x00, 0x00, 0xE8, 0x3B, 0x00, 0x72, 0xE8,
|
||||
0x5B, 0x8A, 0x56, 0x24, 0xBE, 0x0B, 0x7C, 0x8B, 0xFC, 0xC7, 0x46, 0xF0,
|
||||
0x3D, 0x7D, 0xC7, 0x46, 0xF4, 0x29, 0x7D, 0x8C, 0xD9, 0x89, 0x4E, 0xF2,
|
||||
0x89, 0x4E, 0xF6, 0xC6, 0x06, 0x96, 0x7D, 0xCB, 0xEA, 0x03, 0x00, 0x00,
|
||||
0x20, 0x0F, 0xB6, 0xC8, 0x66, 0x8B, 0x46, 0xF8, 0x66, 0x03, 0x46, 0x1C,
|
||||
0x66, 0x8B, 0xD0, 0x66, 0xC1, 0xEA, 0x10, 0xEB, 0x5E, 0x0F, 0xB6, 0xC8,
|
||||
0x4A, 0x4A, 0x8A, 0x46, 0x0D, 0x32, 0xE4, 0xF7, 0xE2, 0x03, 0x46, 0xFC,
|
||||
0x13, 0x56, 0xFE, 0xEB, 0x4A, 0x52, 0x50, 0x06, 0x53, 0x6A, 0x01, 0x6A,
|
||||
0x10, 0x91, 0x8B, 0x46, 0x18, 0x96, 0x92, 0x33, 0xD2, 0xF7, 0xF6, 0x91,
|
||||
0xF7, 0xF6, 0x42, 0x87, 0xCA, 0xF7, 0x76, 0x1A, 0x8A, 0xF2, 0x8A, 0xE8,
|
||||
0xC0, 0xCC, 0x02, 0x0A, 0xCC, 0xB8, 0x01, 0x02, 0x80, 0x7E, 0x02, 0x0E,
|
||||
0x75, 0x04, 0xB4, 0x42, 0x8B, 0xF4, 0x8A, 0x56, 0x24, 0xCD, 0x13, 0x61,
|
||||
0x61, 0x72, 0x0B, 0x40, 0x75, 0x01, 0x42, 0x03, 0x5E, 0x0B, 0x49, 0x75,
|
||||
0x06, 0xF8, 0xC3, 0x41, 0xBB, 0x00, 0x00, 0x60, 0x66, 0x6A, 0x00, 0xEB,
|
||||
0xB0, 0x4E, 0x54, 0x4C, 0x44, 0x52, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
|
||||
0x0D, 0x0A, 0x52, 0x65, 0x6D, 0x6F, 0x76, 0x65, 0x20, 0x64, 0x69, 0x73,
|
||||
0x6B, 0x73, 0x20, 0x6F, 0x72, 0x20, 0x6F, 0x74, 0x68, 0x65, 0x72, 0x20,
|
||||
0x6D, 0x65, 0x64, 0x69, 0x61, 0x2E, 0xFF, 0x0D, 0x0A, 0x44, 0x69, 0x73,
|
||||
0x6B, 0x20, 0x65, 0x72, 0x72, 0x6F, 0x72, 0xFF, 0x0D, 0x0A, 0x50, 0x72,
|
||||
0x65, 0x73, 0x73, 0x20, 0x61, 0x6E, 0x79, 0x20, 0x6B, 0x65, 0x79, 0x20,
|
||||
0x74, 0x6F, 0x20, 0x72, 0x65, 0x73, 0x74, 0x61, 0x72, 0x74, 0x0D, 0x0A,
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xAC, 0xCB, 0xD8, 0x55, 0xAA };
|
||||
|
||||
static u8 gDisk_buff[0x2600]; //RAM Buffer used to implement the virtual disk
|
||||
static u32 gDisk_var[(512 + 32 + 28) / 4]; //
|
||||
static u32 *gV32 = (u32*) &gDisk_var[512 / 4];
|
||||
static u8 *gVar = (u8*) &gDisk_var[512 / 4 + 8];
|
||||
|
||||
static u8 *gBuff = (u8*) &gDisk_var[0];
|
||||
const u8 gFat_data[] = { 0xF8, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF }; //{0xF8,0XFF,0XFF,0xff,0X0f};//
|
||||
//The options
|
||||
const char *gKey_words[] = { "T_Standby", "T_Work", "Wait_Time", "Idle_Time",
|
||||
"T_Step", "Turn_Off_v", "TempShowFlag", "ZeroP_Ad" };
|
||||
//default settings
|
||||
const char *gDef_set[] = { "T_Standby=200", "T_Work=300", "Wait_Time=180",
|
||||
"Idle_Time=360", "T_Step=10", "Turn_Off_v=10", "TempShowFlag=0",
|
||||
"ZeroP_Ad=239" };
|
||||
//comments for accepted range
|
||||
const char *gSet_range[] = { " #(100~400)\r\n", " #(100~400)\r\n",
|
||||
" #(60~9999)\r\n", " #(300~9999)\r\n", " #(5~25)\r\n",
|
||||
" #(9~12)\r\n", " #(0,1)\r\n", " #ReadOnly\r\n" };
|
||||
|
||||
static u8 gFile_con[512]; //file contents buffer
|
||||
#define CONFIG_CONT 8 /*Number of variables in config.txt*/
|
||||
u8 gRewriteflag[16]; //This flags if this sector has changed and needs to be written to flash
|
||||
|
||||
#define ROW_CONT 35
|
||||
#define FILE_CONT 254
|
||||
/*******************************************************************************
|
||||
Function: Soft_Delay()
|
||||
Description: Small software delay.
|
||||
*******************************************************************************/
|
||||
void Soft_Delay() {
|
||||
int i, j;
|
||||
for (i = 0; i < 1000; i++)
|
||||
for (j = 0; j < 100; j++)
|
||||
;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Set_Ver
|
||||
Description:
|
||||
Input:
|
||||
*******************************************************************************/
|
||||
void Set_Ver(u8 str[], u8 k) {
|
||||
s16 set_ver = 0;
|
||||
|
||||
switch (k) {
|
||||
case 0:
|
||||
set_ver = (str[0] - 48) * 100 + (str[1] - 48) * 10 + (str[2] - 48);
|
||||
device_info.t_standby = set_ver * 10;
|
||||
break;
|
||||
case 1:
|
||||
set_ver = (str[0] - 48) * 100 + (str[1] - 48) * 10 + (str[2] - 48);
|
||||
if (!gCalib_flag)
|
||||
device_info.t_work = set_ver * 10;
|
||||
break;
|
||||
case 2:
|
||||
if (str[3] <= '9' && str[3] >= '0') { //4
|
||||
set_ver = (str[0] - 48) * 1000 + (str[1] - 48) * 100
|
||||
+ (str[2] - 48) * 10 + (str[3] - 48);
|
||||
} else if (str[2] <= '9' && str[2] >= '0') { //3
|
||||
set_ver = (str[0] - 48) * 100 + (str[1] - 48) * 10 + (str[2] - 48);
|
||||
} else if (str[1] <= '9' && str[1] >= '0') { //2
|
||||
set_ver = (str[0] - 48) * 10 + (str[1] - 48);
|
||||
}
|
||||
device_info.wait_time = set_ver * 100;
|
||||
break;
|
||||
case 3:
|
||||
if (str[3] <= '9' && str[3] >= '0') { //4
|
||||
set_ver = (str[0] - 48) * 1000 + (str[1] - 48) * 100
|
||||
+ (str[2] - 48) * 10 + (str[3] - 48);
|
||||
} else if (str[2] <= '9' && str[2] >= '0') { //3
|
||||
set_ver = (str[0] - 48) * 100 + (str[1] - 48) * 10 + (str[2] - 48);
|
||||
}
|
||||
device_info.idle_time = set_ver * 100;
|
||||
break;
|
||||
case 4:
|
||||
if (str[1] <= '9' && str[1] >= '0') { //2
|
||||
set_ver = (str[0] - 48) * 10 + (str[1] - 48);
|
||||
} else {
|
||||
set_ver = str[0] - 48;
|
||||
}
|
||||
device_info.t_step = set_ver * 10;
|
||||
break;
|
||||
case 5:
|
||||
if (str[3] <= '9' && str[3] >= '0') { //4
|
||||
set_ver = (str[0] - 48) * 1000 + (str[1] - 48) * 100
|
||||
+ (str[2] - 48) * 10 + (str[3] - 48);
|
||||
} else if (str[2] <= '9' && str[2] >= '0') { //3
|
||||
set_ver = (str[0] - 48) * 100 + (str[1] - 48) * 10 + (str[2] - 48);
|
||||
} else if (str[1] <= '9' && str[1] >= '0') { //2
|
||||
set_ver = (str[0] - 48) * 10 + (str[1] - 48);
|
||||
} else {
|
||||
set_ver = str[0] - 48;
|
||||
}
|
||||
gTurn_offv = set_ver * 10;
|
||||
break;
|
||||
case 6:
|
||||
set_ver = str[0] - 48;
|
||||
Set_TemperatureShowFlag(set_ver);
|
||||
break;
|
||||
case 7:
|
||||
if (str[2] <= '9' && str[2] >= '0') { //3
|
||||
set_ver = (str[0] - 48) * 100 + (str[1] - 48) * 10 + (str[2] - 48);
|
||||
} else if (str[1] <= '9' && str[1] >= '0') { //2
|
||||
set_ver = (str[0] - 48) * 10 + (str[1] - 48);
|
||||
} else {
|
||||
set_ver = str[0] - 48;
|
||||
}
|
||||
if (!gCalib_flag)
|
||||
gZerop_ad = set_ver;
|
||||
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Cal_Val
|
||||
Description:
|
||||
Inputs:
|
||||
Output:
|
||||
*******************************************************************************/
|
||||
u8 Cal_Val(u8 str[], u8 k, u8 flag) {
|
||||
u16 set_ver;
|
||||
|
||||
switch (k) {
|
||||
case 0:
|
||||
case 1:
|
||||
if (str[2] > '9' || str[2] < '0' || //
|
||||
str[1] > '9' || str[1] < '0' || //
|
||||
str[0] > '4' || str[0] <= '0' || //
|
||||
(str[0] == '4' && (str[1] != '0' || str[2] != '0')))
|
||||
return 0;
|
||||
break;
|
||||
case 2:
|
||||
if (str[3] <= '9' && str[3] >= '0') { //
|
||||
if ((str[2] > '9' && str[2] < '0')
|
||||
|| (str[1] > '9' && str[1] < '0')) //
|
||||
return 0;
|
||||
} else if (str[2] <= '9' && str[2] >= '0') { //
|
||||
if (str[1] > '9' && str[1] < '0') //
|
||||
return 0;
|
||||
} else if (str[1] <= '9' && str[1] >= '0') { //
|
||||
if (str[0] > '9' || str[0] < '6') //
|
||||
return 0;
|
||||
} else {
|
||||
return 0;
|
||||
}
|
||||
break;
|
||||
case 3:
|
||||
if (str[3] <= '9' && str[3] >= '0') { //4
|
||||
if ((str[2] > '9' && str[2] < '0')
|
||||
|| (str[1] > '9' && str[1] < '0')) //
|
||||
return 0;
|
||||
} else if (str[2] <= '9' && str[2] >= '0') { //3
|
||||
if (str[0] > '9' || str[0] < '3') //
|
||||
return 0;
|
||||
} else { //
|
||||
return 0;
|
||||
}
|
||||
break;
|
||||
case 4: //T_Step=10 #(5~25)
|
||||
if (str[1] <= '5' && str[1] >= '0') { //
|
||||
if (str[0] > '2' || str[0] < '0') //
|
||||
return 0;
|
||||
} else {
|
||||
if (str[0] < '5' && (str[0] != '1')) {
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
break;
|
||||
case 5: //Turn_Off_v=10 #(9~12)
|
||||
if (str[1] <= '2' && str[1] >= '0') { //
|
||||
if (str[0] > '9' || str[0] < '0') //
|
||||
return 0;
|
||||
} else {
|
||||
if (str[0] < '9') {
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
break;
|
||||
case 6: //TempShowFlag=0 #(0,1)
|
||||
if (str[0] != '1' && str[0] != '0')
|
||||
return 0;
|
||||
break;
|
||||
case 7:
|
||||
if (str[2] <= '9' && str[2] >= '0') { //3
|
||||
set_ver = (str[0] - 48) * 100 + (str[1] - 48) * 10 + (str[2] - 48);
|
||||
} else if (str[1] <= '9' && str[1] >= '0') { //2
|
||||
set_ver = (str[0] - 48) * 10 + (str[1] - 48);
|
||||
} else {
|
||||
set_ver = str[0] - 48;
|
||||
}
|
||||
if (flag == 1) {
|
||||
if (set_ver != gZerop_ad)
|
||||
return 0;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:Disk_BuffInit
|
||||
Description: Initializes the buffer for the virtual disk. By loading from the chips flash
|
||||
*******************************************************************************/
|
||||
void Disk_BuffInit(void) {
|
||||
memcpy(gDisk_buff, (u8*) APP_BASE, 0x2600);
|
||||
memset(gRewriteflag, 0, 16);
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Upper
|
||||
Description: Converts the string passed in to upper case
|
||||
Inputs: (str) buffer to change, (len) length of the buffer
|
||||
*******************************************************************************/
|
||||
void Upper(u8* str, u16 len) {
|
||||
u16 i;
|
||||
for (i = 0; i < len; i++) //Loop through the string
|
||||
if (str[i] >= 'a' && str[i] <= 'z') //if char is lower case
|
||||
str[i] -= 32; //shift to upper case
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: SearchFile
|
||||
Description:
|
||||
Inputs: (pfilename) filename to look for, (pfilelen) length of the file,(root_addr) root folder to search from
|
||||
Outputs: NULL (failed) or pointer to file start
|
||||
*******************************************************************************/
|
||||
u8* SearchFile(u8* pfilename, u16* pfilelen, u16* root_addr) {
|
||||
u16 n, sector;
|
||||
u8 str_name[11];
|
||||
u8* pdiraddr;
|
||||
|
||||
pdiraddr = ROOT_SECTOR;
|
||||
|
||||
for (n = 0; n < 16; n++) {
|
||||
memcpy(str_name, pdiraddr, 11);
|
||||
Upper(str_name, 11); //ensure path is upper case
|
||||
if (memcmp(str_name, pfilename, 11) == 0) {
|
||||
memcpy((u8*) pfilelen, pdiraddr + 0x1C, 2);
|
||||
memcpy((u8*) §or, pdiraddr + 0x1A, 2);
|
||||
return (u8*) FILE_SECTOR + (sector - 2) * 512;
|
||||
}
|
||||
|
||||
pdiraddr += 32;
|
||||
root_addr++;
|
||||
}
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:Config_Analysis
|
||||
Description:Reads the CONFIG.TXT if file is found and also the LOGIN.BMP file as well
|
||||
|
||||
*******************************************************************************/
|
||||
u8 Config_Analysis(void) {
|
||||
u32 i, j, k, m, flag;
|
||||
u16 file_len;
|
||||
u8 t_p[CONFIG_CONT][ROW_CONT];
|
||||
u8 str[FILE_CONT];
|
||||
u8 is_illegality = 0;
|
||||
u8* p_file;
|
||||
u16 root_addr;
|
||||
|
||||
root_addr = 0;
|
||||
m = 0;
|
||||
j = 0;
|
||||
//read in the config.txt if it exists
|
||||
if ((p_file = SearchFile((u8*) ("CONFIG TXT"), &file_len, &root_addr))) {
|
||||
memset(t_p, 0x00, CONFIG_CONT * ROW_CONT);
|
||||
memcpy((u8*) gFile_con, p_file, 512);
|
||||
for (k = 0; k < CONFIG_CONT; k++) {
|
||||
j = 0;
|
||||
for (i = m; i < strlen((char *) gFile_con); i++) {
|
||||
if (gFile_con[i] == 0x0D && gFile_con[i + 1] == 0x0A)
|
||||
break;
|
||||
else {
|
||||
if (j < ROW_CONT)
|
||||
t_p[k][j++] = gFile_con[i];
|
||||
m++;
|
||||
}
|
||||
}
|
||||
t_p[k][j] = '\0';
|
||||
m = i + 2;
|
||||
}
|
||||
for (k = 0; k < CONFIG_CONT; k++) {
|
||||
if (memcmp(t_p[k], gKey_words[k], strlen(gKey_words[k])) == 0) {
|
||||
flag = 0;
|
||||
for (i = strlen(gKey_words[k]); i < strlen((char *) t_p[k]);
|
||||
i++) {
|
||||
if (t_p[k][i] >= '0' && t_p[k][i] <= '9') {
|
||||
if (t_p[k][i] == '0') {
|
||||
if (k == 6) {
|
||||
flag = 1;
|
||||
break;
|
||||
} else {
|
||||
flag = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
flag = 1;
|
||||
break;
|
||||
} else if ((t_p[k][i] != 0x20) && (t_p[k][i] != 0x3d)) {
|
||||
flag = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (flag && Cal_Val(t_p[k] + i, k, 0)) {
|
||||
Set_Ver(t_p[k] + i, k);
|
||||
if (k == 0)
|
||||
sprintf((char *) t_p[k], "T_Standby=%d",
|
||||
device_info.t_standby / 10);
|
||||
else if (k == 1)
|
||||
sprintf((char *) t_p[k], "T_Work=%d",
|
||||
device_info.t_work / 10);
|
||||
else if (k == 2)
|
||||
sprintf((char *) t_p[k], "Wait_Time=%ld",
|
||||
device_info.wait_time / 100);
|
||||
else if (k == 3)
|
||||
sprintf((char *) t_p[k], "Idle_Time=%ld",
|
||||
device_info.idle_time / 100);
|
||||
else if (k == 4)
|
||||
sprintf((char *) t_p[k], "T_Step=%d",
|
||||
device_info.t_step / 10);
|
||||
else if (k == 5)
|
||||
sprintf((char *) t_p[k], "Turn_Off_v=%ld",
|
||||
gTurn_offv / 10);
|
||||
else if (k == 6)
|
||||
sprintf((char *) t_p[k], "TempShowFlag=%d",
|
||||
Get_TemperatureShowFlag());
|
||||
else if (k == 7)
|
||||
sprintf((char *) t_p[k], "ZeroP_Ad=%ld", gZerop_ad);
|
||||
} else {
|
||||
memset(t_p[k], 0, strlen((char *) t_p[k]));
|
||||
memcpy(t_p[k], gDef_set[k], strlen((char *) gDef_set[k]));
|
||||
is_illegality = 1;
|
||||
}
|
||||
} else {
|
||||
memcpy(t_p[k], gDef_set[k], strlen((char *) gDef_set[k]));
|
||||
is_illegality = 1;
|
||||
}
|
||||
}
|
||||
|
||||
if (is_illegality || gCalib_flag) {
|
||||
memset(str, 0x00, FILE_CONT);
|
||||
m = 0;
|
||||
for (k = 0; k < CONFIG_CONT; k++) {
|
||||
strcat((char *) str, (char *) t_p[k]);
|
||||
strcat((char *) str, (char *) gSet_range[k]);
|
||||
}
|
||||
m = strlen((char *) str);
|
||||
|
||||
if (m < 256) {
|
||||
gDisk_buff[0x400 + root_addr * 32 + 0x1C] = m; //strlen((char *)str);
|
||||
gDisk_buff[0x400 + root_addr * 32 + 0x1D] = 0;
|
||||
} else {
|
||||
gDisk_buff[0x400 + root_addr * 32 + 0x1C] = m % 256;
|
||||
gDisk_buff[0x400 + root_addr * 32 + 0x1D] = m / 256;
|
||||
}
|
||||
|
||||
gRewriteflag[(p_file - ROOT_SECTOR + 0x200) / 0x400] = 1;
|
||||
memcpy(p_file, str, strlen((char *) str));
|
||||
ReWriteFlsash();
|
||||
}
|
||||
} else {
|
||||
if ((p_file = SearchFile("LOGOIN BMP", &file_len, &root_addr))) {
|
||||
memcpy(str, p_file, 254);
|
||||
memset(gDisk_buff, 0x00, 0x2600);
|
||||
memcpy(ROOT_SECTOR + 32, "LOGOIN BMP", 0xC);
|
||||
memcpy(FILE_SECTOR + 512, str, 254);
|
||||
gDisk_buff[0x40B + 32] = 0x0; //<2F><><EFBFBD><EFBFBD>
|
||||
*(u32*) (VOLUME_BASE + 32) = VOLUME;
|
||||
gDisk_buff[0x41A + 32] = 0x03; //<2F>غ<EFBFBD>
|
||||
gDisk_buff[0x41C + 32] = 254; //<2F>ļ<EFBFBD><C4BC><EFBFBD>С
|
||||
} else {
|
||||
memset(gDisk_buff, 0x00, 0x2600);
|
||||
}
|
||||
|
||||
memcpy(ROOT_SECTOR, "CONFIG TXT", 0xC);
|
||||
memcpy(FAT1_SECTOR, gFat_data, 6);
|
||||
memcpy(FAT2_SECTOR, gFat_data, 6);
|
||||
|
||||
m = 0;
|
||||
for (k = 0; k < CONFIG_CONT; k++) {
|
||||
memcpy(FILE_SECTOR + m, gDef_set[k], strlen((char *) gDef_set[k]));
|
||||
m += strlen((char *) gDef_set[k]);
|
||||
memcpy(FILE_SECTOR + m, gSet_range[k],
|
||||
strlen((char *) gSet_range[k]));
|
||||
m += strlen((char *) gSet_range[k]);
|
||||
}
|
||||
|
||||
gDisk_buff[0x40B] = 0x0;
|
||||
*(u32*) VOLUME_BASE = VOLUME;
|
||||
gDisk_buff[0x41A] = 0x02;
|
||||
gDisk_buff[0x41C] = m;
|
||||
ReWrite_All();
|
||||
}
|
||||
|
||||
gVar[F_TYPE] = HEX;
|
||||
gVar[F_FLAG] = RDY;
|
||||
gVar[SEG_ST] = 0;
|
||||
gV32[OFFSET] = 0;
|
||||
gV32[COUNT] = 0;
|
||||
gV32[WR_CNT] = 0;
|
||||
gV32[RD_CNT] = 0;
|
||||
return 0;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Disk_SecWrite
|
||||
Description:
|
||||
Inputs:
|
||||
*******************************************************************************/
|
||||
void Disk_SecWrite(u8* pbuffer, u32 diskaddr) {
|
||||
u32 i, j, k, m, flag;
|
||||
u8 t_p[CONFIG_CONT][ROW_CONT];
|
||||
u8 str[FILE_CONT];
|
||||
u8 ver[20];
|
||||
static u16 Config_flag = 0;
|
||||
|
||||
if (diskaddr == 0x1000) { // Write FAT1 sector
|
||||
if (memcmp(pbuffer, (u8*) FAT1_SECTOR, 512)) { //check different
|
||||
memcpy((u8*) FAT1_SECTOR, pbuffer, 512);
|
||||
gRewriteflag[0] = 1;
|
||||
}
|
||||
} else if (diskaddr == 0x2800) { // Write FAT2 sector
|
||||
if (memcmp(pbuffer, (u8*) FAT2_SECTOR, 512)) { //check different
|
||||
memcpy((u8*) FAT2_SECTOR, pbuffer, 512);
|
||||
gRewriteflag[0] = 1;
|
||||
}
|
||||
} else if (diskaddr == 0x4000) { // Write DIR sector
|
||||
if (memcmp(pbuffer, (u8*) ROOT_SECTOR, 512)) { //check different
|
||||
memcpy((u8*) ROOT_SECTOR, pbuffer, 512);
|
||||
gRewriteflag[1] = 1;
|
||||
for (i = 0; i < 16; i++) {
|
||||
memcpy((u8*) ver, (u8*) (pbuffer), 12); //copy the filename out for comparison
|
||||
if (memcmp(ver, "CONFIG TXT", 11) == 0) { //if file name matches
|
||||
Config_flag = pbuffer[0x1A];
|
||||
break;
|
||||
}
|
||||
pbuffer += 32; //move to the next chunk of the pbuffer
|
||||
}
|
||||
}
|
||||
} else if (diskaddr >= 0x8000 && diskaddr <= 0xA000) { // Write FILE sector
|
||||
if (memcmp(pbuffer, (u8*) (FILE_SECTOR + (diskaddr - 0x8000)), 512)) { //check if different
|
||||
memcpy((u8*) (FILE_SECTOR + (diskaddr - 0x8000)), pbuffer, 512);
|
||||
}
|
||||
if ((((diskaddr - 0x8000) / 0x200) + 2) == Config_flag) {
|
||||
m = 0;
|
||||
memset(t_p, 0x00, CONFIG_CONT * ROW_CONT);
|
||||
memcpy((u8*) (gFile_con), pbuffer, 512);
|
||||
|
||||
for (k = 0; k < CONFIG_CONT; k++) { //
|
||||
j = 0;
|
||||
for (i = m; i < strlen((char *) gFile_con); i++) { //
|
||||
if (gFile_con[i] == 0x0D && gFile_con[i + 1] == 0x0A)
|
||||
break;
|
||||
else {
|
||||
if (j < ROW_CONT)
|
||||
t_p[k][j++] = gFile_con[i];
|
||||
m++;
|
||||
}
|
||||
}
|
||||
t_p[k][j] = '\0';
|
||||
m = i + 2;
|
||||
}
|
||||
|
||||
for (k = 0; k < CONFIG_CONT; k++) {
|
||||
if (memcmp(t_p[k], gKey_words[k], strlen(gKey_words[k])) == 0) {
|
||||
flag = 0;
|
||||
for (i = strlen(gKey_words[k]); i < strlen((char *) t_p[k]);
|
||||
i++) {
|
||||
if (t_p[k][i] >= '0' && t_p[k][i] <= '9') {
|
||||
if (t_p[k][i] == '0') {
|
||||
if (k == 6) {
|
||||
flag = 1;
|
||||
break;
|
||||
} else {
|
||||
flag = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
flag = 1;
|
||||
break;
|
||||
} else if ((t_p[k][i] != 0x20) && (t_p[k][i] != 0x3d)) {
|
||||
flag = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
if ((!flag) || (!Cal_Val(t_p[k] + i, k, 1))) {
|
||||
return;
|
||||
} else {
|
||||
Set_Ver(t_p[k] + i, k);
|
||||
|
||||
memset(t_p[k], 0, strlen((char *) t_p[k]));
|
||||
if (k == 0)
|
||||
sprintf((char *) t_p[k], "T_Standby=%d",
|
||||
device_info.t_standby / 10);
|
||||
else if (k == 1)
|
||||
sprintf((char *) t_p[k], "T_Work=%d",
|
||||
device_info.t_work / 10);
|
||||
else if (k == 2)
|
||||
sprintf((char *) t_p[k], "Wait_Time=%ld",
|
||||
device_info.wait_time / 100);
|
||||
else if (k == 3)
|
||||
sprintf((char *) t_p[k], "Idle_Time=%ld",
|
||||
device_info.idle_time / 100);
|
||||
else if (k == 4)
|
||||
sprintf((char *) t_p[k], "T_Step=%d",
|
||||
device_info.t_step / 10);
|
||||
else if (k == 5)
|
||||
sprintf((char *) t_p[k], "Turn_Off_v=%ld",
|
||||
gTurn_offv / 10);
|
||||
else if (k == 6)
|
||||
sprintf((char *) t_p[k], "TempShowFlag=%d",
|
||||
Get_TemperatureShowFlag());
|
||||
else if (k == 7)
|
||||
sprintf((char *) t_p[k], "ZeroP_Ad=%ld", gZerop_ad);
|
||||
}
|
||||
} else {
|
||||
memcpy(t_p[k], gDef_set[k], strlen((char *) gDef_set[k]));
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
memset(str, 0, FILE_CONT);
|
||||
for (k = 0; k < CONFIG_CONT; k++) {
|
||||
strcat((char *) str, (char *) t_p[k]);
|
||||
strcat((char *) str, (char *) gSet_range[k]);
|
||||
}
|
||||
m = strlen((char *) str);
|
||||
gDisk_buff[0x400 + (Config_flag - 2) * 32 + 0x1C] = m % 256;
|
||||
gDisk_buff[0x400 + (Config_flag - 2) * 32 + 0x1D] = m / 256;
|
||||
|
||||
memcpy((u8*) (FILE_SECTOR), (u8*) str, 512);
|
||||
gRewriteflag[1] = 1;
|
||||
gRewriteflag[((diskaddr - 0x8000 + 0x200) / 0x400) + 1] = 1;
|
||||
ReWriteFlsash();
|
||||
return;
|
||||
|
||||
}
|
||||
|
||||
gRewriteflag[1] = 1;
|
||||
gRewriteflag[((diskaddr - 0x8000 + 0x200) / 0x400) + 1] = 1;
|
||||
ReWriteFlsash();
|
||||
}
|
||||
ReWriteFlsash();
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function: Disk_SecRead
|
||||
Description: Reads a sector from the virtual disk
|
||||
*******************************************************************************/
|
||||
void Disk_SecRead(u8* pbuffer, u32 disk_addr) {
|
||||
Soft_Delay();
|
||||
if (disk_addr == 0x0000) { // Read BOOT sector
|
||||
memcpy(pbuffer, BOOT_SEC, 512);
|
||||
} else if (disk_addr == 0x1000) { // Read FAT1 sector
|
||||
memcpy(pbuffer, FAT1_SECTOR, 512);
|
||||
} else if (disk_addr == 0x2800) { // Read FAT2 sector
|
||||
memcpy(pbuffer, FAT2_SECTOR, 512);
|
||||
} else if (disk_addr == 0x4000) { // Read DIR sector
|
||||
memcpy(pbuffer, (u8*) (ROOT_SECTOR), 512);
|
||||
} else if (disk_addr >= 0x8000 && disk_addr <= 0xA000) { // Read FILE sector
|
||||
memcpy(pbuffer, (u8*) (APP_BASE + 0x600 + (disk_addr - 0x8000)), 512);
|
||||
} else {
|
||||
memset(pbuffer, 0, 512); //unknown, return 0's
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:ReWriteFlsash
|
||||
Description:
|
||||
Output:RDY(all good) or ERR (error)
|
||||
*******************************************************************************/
|
||||
u8 ReWriteFlsash(void) {
|
||||
u32 i, j;
|
||||
u8 result;
|
||||
u16 *f_buff;
|
||||
|
||||
FLASH_Unlock();
|
||||
for (i = 0; i < 16; i++) {
|
||||
if (gRewriteflag[i]) {
|
||||
gRewriteflag[i] = 0;
|
||||
FLASH_Erase(APP_BASE + i * 0x400);
|
||||
f_buff = (u16*) &gDisk_buff[i * 0x400];
|
||||
for (j = 0; j < 0x400; j += 2) { //Loop through the 1k block
|
||||
result = FLASH_Prog((u32) (APP_BASE + i * 0x400 + j), //program each 16 bit block
|
||||
*f_buff++);
|
||||
if (result != FLASH_COMPLETE) { //something went wrong
|
||||
FLASH_Lock(); //make sure the flash is locked again
|
||||
return ERR; //return ERR
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
FLASH_Lock();
|
||||
return RDY;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: ReWrite_All
|
||||
Description:
|
||||
Output:
|
||||
*******************************************************************************/
|
||||
u8 ReWrite_All(void) {
|
||||
u16 i;
|
||||
u8 result;
|
||||
u16 *f_buff = (u16*) gDisk_buff;
|
||||
|
||||
FLASH_Unlock();
|
||||
for (i = 0; i < 9; i++)
|
||||
FLASH_Erase(APP_BASE + i * 0x400);
|
||||
for (i = 0; i < 0X2600; i += 2) {
|
||||
result = FLASH_Prog((u32) (APP_BASE + i), *f_buff++);
|
||||
if (result != FLASH_COMPLETE)
|
||||
return ERR;
|
||||
}
|
||||
FLASH_Lock();
|
||||
return RDY;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:Erase
|
||||
Description: Erase the first 9k from APP_BASE
|
||||
*******************************************************************************/
|
||||
void Erase(void) {
|
||||
u16 i;
|
||||
FLASH_Unlock(); //unlock the mcu flash controller
|
||||
for (i = 0; i < 9; i++)
|
||||
FLASH_Erase(APP_BASE + i * 0x400); //erase the flash
|
||||
|
||||
FLASH_Lock();
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Read_Memory
|
||||
Description:
|
||||
*******************************************************************************/
|
||||
void Read_Memory(u32 r_offset, u32 r_length) {
|
||||
static u32 offset, length, block_offset;
|
||||
|
||||
if (gVar[USB_ST] == TXFR_IDLE) {
|
||||
offset = r_offset * SECTOR_SIZE;
|
||||
length = r_length * SECTOR_SIZE;
|
||||
gVar[USB_ST] = TXFR_ONGOING;
|
||||
}
|
||||
if (gVar[USB_ST] == TXFR_ONGOING) {
|
||||
if (!gV32[RD_CNT]) {
|
||||
Disk_SecRead(gBuff, offset);
|
||||
UserToPMABufferCopy(gBuff, ENDP1_TXADDR, BULK_MAX_PACKET_SIZE);
|
||||
gV32[RD_CNT] = SECTOR_SIZE - BULK_MAX_PACKET_SIZE;
|
||||
block_offset = BULK_MAX_PACKET_SIZE;
|
||||
} else {
|
||||
UserToPMABufferCopy(gBuff + block_offset, ENDP1_TXADDR,
|
||||
BULK_MAX_PACKET_SIZE);
|
||||
gV32[RD_CNT] -= BULK_MAX_PACKET_SIZE;
|
||||
block_offset += BULK_MAX_PACKET_SIZE;
|
||||
}
|
||||
SetEPTxCount(ENDP1, BULK_MAX_PACKET_SIZE);
|
||||
SetEPTxStatus(ENDP1, EP_TX_VALID);
|
||||
offset += BULK_MAX_PACKET_SIZE;
|
||||
length -= BULK_MAX_PACKET_SIZE;
|
||||
|
||||
CSW.dDataResidue -= BULK_MAX_PACKET_SIZE;
|
||||
}
|
||||
if (length == 0) {
|
||||
gV32[RD_CNT] = 0;
|
||||
block_offset = 0;
|
||||
offset = 0;
|
||||
Bot_State = BOT_DATA_IN_LAST;
|
||||
gVar[USB_ST] = TXFR_IDLE;
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Write_Memory
|
||||
Description:
|
||||
*******************************************************************************/
|
||||
void Write_Memory(u32 w_offset, u32 w_length) {
|
||||
static u32 offset, length;
|
||||
u32 idx, temp = gV32[WR_CNT] + 64;
|
||||
|
||||
if (gVar[USB_ST] == TXFR_IDLE) {
|
||||
offset = w_offset * SECTOR_SIZE;
|
||||
length = w_length * SECTOR_SIZE;
|
||||
gVar[USB_ST] = TXFR_ONGOING;
|
||||
}
|
||||
if (gVar[USB_ST] == TXFR_ONGOING) {
|
||||
for (idx = 0; gV32[WR_CNT] < temp; gV32[WR_CNT]++)
|
||||
*(u8 *) (gBuff + gV32[WR_CNT]) = Bulk_Buff[idx++];
|
||||
|
||||
offset += Data_Len;
|
||||
length -= Data_Len;
|
||||
|
||||
if (!(length % SECTOR_SIZE)) {
|
||||
gV32[WR_CNT] = 0;
|
||||
Disk_SecWrite(gBuff, offset - SECTOR_SIZE);
|
||||
}
|
||||
|
||||
CSW.dDataResidue -= Data_Len;
|
||||
SetEPRxStatus(ENDP2, EP_RX_VALID); /* enable the next transaction*/
|
||||
}
|
||||
if ((length == 0) || (Bot_State == BOT_CSW_Send)) {
|
||||
gV32[WR_CNT] = 0;
|
||||
Set_CSW(CSW_CMD_PASSED, SEND_CSW_ENABLE);
|
||||
gVar[USB_ST] = TXFR_IDLE;
|
||||
}
|
||||
}
|
||||
/********************************* END OF FILE ******************************/
|
||||
@@ -1,198 +0,0 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. ********************
|
||||
File Name : EXT_Flash.c
|
||||
Version : S100 APP Ver 2.11
|
||||
Description:
|
||||
Author : bure
|
||||
Data:
|
||||
History:
|
||||
*******************************************************************************/
|
||||
|
||||
#include <string.h>
|
||||
#include <stdio.h>
|
||||
#include "Ext_Flash.h"
|
||||
#include "Bios.h"
|
||||
|
||||
|
||||
#define OK 0 // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
#define SEC_ERR 1 // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>д<EFBFBD><D0B4><EFBFBD><EFBFBD>
|
||||
#define TMAX 100000 // <20><>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD>
|
||||
|
||||
u32 Mass_Memory_Size;
|
||||
u32 Mass_Block_Size;
|
||||
u32 Mass_Block_Count;
|
||||
u32 Tout;
|
||||
|
||||
|
||||
u8 flash_mode;
|
||||
|
||||
void ExtFLASH_SectorErase(u32 SectorAddr);
|
||||
|
||||
/*******************************************************************************
|
||||
SPI_FLASH_SectorErase : Sector Erases the specified FLASH Page.(4k/sector)
|
||||
*******************************************************************************/
|
||||
void ExtFLASH_SectorErase(u32 SectorAddr)
|
||||
{
|
||||
ExtFlash_WriteEnable();
|
||||
ExtFlash_CS_LOW();
|
||||
ExtFlash_SendByte(SE);
|
||||
ExtFlash_SendByte((SectorAddr & 0xFF0000) >> 16); //Send high address byte
|
||||
ExtFlash_SendByte((SectorAddr & 0xFF00) >> 8); //Send medium address byte
|
||||
ExtFlash_SendByte(SectorAddr & 0xFF); //Send low address byte
|
||||
ExtFlash_CS_HIGH();
|
||||
ExtFlash_WaitForWriteEnd(); // Wait the end of Flash writing
|
||||
}
|
||||
|
||||
|
||||
void ExtFlash_PageWR(u8* pBuffer, u32 WriteAddr)
|
||||
{
|
||||
u32 addr,i,j;
|
||||
u8* ptr;
|
||||
u8 page=0,flag=0,write_mode;
|
||||
u8 buffer[256];
|
||||
|
||||
flag=0;
|
||||
if(flash_mode==FLASH_8M) {
|
||||
addr=WriteAddr & 0xFFF000;
|
||||
page=16;
|
||||
} else {
|
||||
page=1;
|
||||
addr=WriteAddr & 0xFFFF00;
|
||||
}
|
||||
while(page>0) {
|
||||
ExtFlash_PageRD((u8*)&buffer,addr, 256);
|
||||
for(j=0; j<255; j++) {
|
||||
if(buffer[j++]!=0xff) {
|
||||
flag=1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
addr+=256;
|
||||
page--;
|
||||
}
|
||||
if(flash_mode==FLASH_8M) {
|
||||
page=16;
|
||||
addr=WriteAddr & 0xFFF000;
|
||||
if(flag==1)ExtFLASH_SectorErase(addr);
|
||||
write_mode=PP;
|
||||
} else {
|
||||
page=1;
|
||||
addr=WriteAddr & 0xFFFF00;
|
||||
if(flag==1)write_mode=PW;
|
||||
else write_mode=PP;
|
||||
}
|
||||
ptr=pBuffer;
|
||||
for(i=0; i<page; i++) {
|
||||
ExtFlash_PageProg(ptr, addr,write_mode);
|
||||
addr+=256;
|
||||
ptr+=256;
|
||||
}
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
дFLASHҳ(256 Bytes)<29><> Mode=0: <20><>0<EFBFBD><30>1<EFBFBD><31><EFBFBD>ݸ<EFBFBD>д Mode=1: <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>д
|
||||
*******************************************************************************/
|
||||
void ExtFlash_PageProg(u8* pBuffer, u32 WriteAddr,u8 CMD)
|
||||
{
|
||||
u16 Lenght = 256;
|
||||
|
||||
ExtFlash_CS_HIGH();
|
||||
ExtFlash_WaitForWriteEnd();
|
||||
ExtFlash_WriteEnable();
|
||||
ExtFlash_CS_LOW();
|
||||
ExtFlash_SendByte(CMD);
|
||||
ExtFlash_SendByte((WriteAddr & 0xFF0000) >> 16);
|
||||
ExtFlash_SendByte((WriteAddr & 0xFF00) >> 8);
|
||||
ExtFlash_SendByte(WriteAddr & 0xFF);
|
||||
while(Lenght--) { // while there is data to be written on the FLASH
|
||||
ExtFlash_SendByte((*pBuffer));
|
||||
pBuffer++;
|
||||
}
|
||||
ExtFlash_CS_HIGH();
|
||||
ExtFlash_WaitForWriteEnd();
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
SPI_FLASH_BufferRead
|
||||
*******************************************************************************/
|
||||
void ExtFlash_PageRD(u8* pBuffer, u32 ReadAddr, u16 Lenght)
|
||||
{
|
||||
ExtFlash_CS_HIGH();
|
||||
ExtFlash_WaitForWriteEnd();
|
||||
ExtFlash_CS_LOW();
|
||||
ExtFlash_SendByte(READ);
|
||||
ExtFlash_SendByte((ReadAddr & 0xFF0000) >> 16);
|
||||
ExtFlash_SendByte((ReadAddr& 0xFF00) >> 8);
|
||||
ExtFlash_SendByte(ReadAddr & 0xFF);
|
||||
|
||||
while(Lenght--) { // while there is data to be read
|
||||
*pBuffer = (ExtFlash_SendByte(Dummy_Byte));
|
||||
pBuffer++;
|
||||
}
|
||||
ExtFlash_CS_HIGH();
|
||||
}
|
||||
/*******************************************************************************
|
||||
SPI_FLASH_ReadByte
|
||||
*******************************************************************************/
|
||||
u8 ExtFlash_ReadByte(void)
|
||||
{
|
||||
return (ExtFlash_SendByte(Dummy_Byte));
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
SPI_FLASH_SendByte
|
||||
*******************************************************************************/
|
||||
u8 ExtFlash_SendByte(u8 byte)
|
||||
{
|
||||
Tout = 0;
|
||||
while(SPI_I2S_GetFlagStatus(SPI3, SPI_I2S_FLAG_TXE) == RESET) {
|
||||
if(Tout++ > TMAX) return 255;
|
||||
}
|
||||
SPI_I2S_SendData(SPI3, byte);
|
||||
Tout = 0;
|
||||
while(SPI_I2S_GetFlagStatus(SPI3, SPI_I2S_FLAG_RXNE) == RESET) {
|
||||
if(Tout++ > TMAX) return 255;
|
||||
}
|
||||
return SPI_I2S_ReceiveData(SPI3);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SPI_FLASH_WriteEnable
|
||||
*******************************************************************************/
|
||||
void ExtFlash_WriteEnable(void)
|
||||
{
|
||||
ExtFlash_CS_LOW();
|
||||
ExtFlash_SendByte(WREN);
|
||||
ExtFlash_CS_HIGH();
|
||||
}
|
||||
/*******************************************************************************
|
||||
SPI_FLASH_WaitForWriteEnd
|
||||
*******************************************************************************/
|
||||
void ExtFlash_WaitForWriteEnd(void)
|
||||
{
|
||||
u8 FLASH_Status = 0;
|
||||
|
||||
ExtFlash_CS_LOW();
|
||||
ExtFlash_SendByte(RDSR);
|
||||
Tout = 0;
|
||||
do {
|
||||
FLASH_Status = ExtFlash_SendByte(Dummy_Byte);
|
||||
if(Tout++ > TMAX) return;
|
||||
} while((FLASH_Status & WIP_Flag) == SET); // Write in progress
|
||||
ExtFlash_CS_HIGH();
|
||||
}
|
||||
/*******************************************************************************
|
||||
MAL_GetStatus
|
||||
*******************************************************************************/
|
||||
void MAL_GetStatus (void)
|
||||
{
|
||||
if(flash_mode==FLASH_8M) {
|
||||
Mass_Block_Count = 2048; //FLASH_SIZE/FLASH_PAGE_SIZE;
|
||||
Mass_Block_Size = 512*8; //FLASH_PAGE_SIZE; 4096
|
||||
Mass_Memory_Size = 512*4096*4 ; //FLASH_SIZE; 0x800000;
|
||||
} else {
|
||||
Mass_Block_Count = 4096; //FLASH_SIZE/FLASH_PAGE_SIZE; 4096
|
||||
Mass_Block_Size = 512; //FLASH_PAGE_SIZE;
|
||||
Mass_Memory_Size = 512*4096 ; //FLASH_SIZE; 0x200000;
|
||||
}
|
||||
}
|
||||
|
||||
/********************************* END OF FILE ******************************/
|
||||
@@ -1,33 +0,0 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. ********************
|
||||
File Name : Flash.c
|
||||
Version : Author : bure
|
||||
*******************************************************************************/
|
||||
#include "APP_Version.h"
|
||||
#include "Flash.h"
|
||||
#include "Bios.h"
|
||||
|
||||
|
||||
/*******************************************************************************
|
||||
Function: FLASH_Prog
|
||||
Description: Programs the data into the system flash at the specified address
|
||||
*******************************************************************************/
|
||||
u8 FLASH_Prog(u32 Address, u16 Data) {
|
||||
if (FLASH_WaitForLastOperation(WAIT_TIMES) != FLASH_TIMEOUT)
|
||||
FLASH_ClearFlag(
|
||||
FLASH_FLAG_EOP | FLASH_FLAG_PGERR | FLASH_FLAG_WRPRTERR);
|
||||
return FLASH_ProgramHalfWord(Address, Data);
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: FLASH_Erase
|
||||
Description: Erases a page of flash
|
||||
Inputs: Starting address for the page to erase
|
||||
*******************************************************************************/
|
||||
void FLASH_Erase(u32 Address) {
|
||||
if (Address % FLASH_PAGE == 0) { // FLASH Page start (1K/Page)
|
||||
if (FLASH_WaitForLastOperation(WAIT_TIMES) != FLASH_TIMEOUT) //wait for last op to finish
|
||||
FLASH_ClearFlag(
|
||||
FLASH_FLAG_EOP | FLASH_FLAG_PGERR | FLASH_FLAG_WRPRTERR);
|
||||
FLASH_ErasePage(Address); // FLASH Page erase
|
||||
}
|
||||
}
|
||||
/********************************* END OF FILE ******************************/
|
||||
@@ -1,384 +0,0 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. **********************
|
||||
File Name : CTRL.c
|
||||
Version : S100 APP Ver 2.11
|
||||
Description:
|
||||
Author : Celery
|
||||
Data: 2015/07/07
|
||||
History:
|
||||
2015/07/07 ͳһ<CDB3><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
2015/07/20 <20>Ӵ<EFBFBD><D3B4>¶ȱ<C2B6><C8B1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
*******************************************************************************/
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include "APP_Version.h"
|
||||
#include "Hardware.h"
|
||||
#include "CTRL.h"
|
||||
#include "Bios.h"
|
||||
#include "UI.h"
|
||||
/******************************************************************************/
|
||||
#define CAL_AD 250
|
||||
const u32 gVol[] = { 3900, 2760, 1720, 584 };
|
||||
const u16 gRate[] = { 300, 150, 90, 40 };
|
||||
s32 gZerop_ad = 239;
|
||||
u32 gTurn_offv = 100;
|
||||
u8 gCalib_flag = 0;
|
||||
vu16 gMeas_cnt = 0;/* Measure*/
|
||||
u32 gKey_in;
|
||||
u8 gLongkey_flag = 0;
|
||||
u8 gAlarm_type = 1;
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Get_CalFlag
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>ȡУ״̬
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:У״̬<D7B4><CCAC>־
|
||||
*******************************************************************************/
|
||||
u32 Get_CalFlag(void) {
|
||||
return gCalib_flag;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Get_gKey
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD>״̬
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:<3A><><EFBFBD><EFBFBD>״̬
|
||||
*******************************************************************************/
|
||||
u32 Get_gKey(void) {
|
||||
return gKey_in;
|
||||
}
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Set_gKey
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><><EFBFBD>ð<EFBFBD><C3B0><EFBFBD>״̬
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:Ҫ<><D2AA><EFBFBD>õİ<C3B5><C4B0><EFBFBD>״̬
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Set_gKey(u32 key) {
|
||||
gKey_in = key;
|
||||
}
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Set_LongKeyFlag
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><><EFBFBD>ó<EFBFBD><C3B3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>־
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:0 :<3A><><EFBFBD><EFBFBD><EFBFBD>Գ<EFBFBD><D4B3><EFBFBD><EFBFBD><EFBFBD> 1: <20><><EFBFBD>Գ<EFBFBD><D4B3><EFBFBD>
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Set_LongKeyFlag(u32 flag) {
|
||||
gLongkey_flag = flag;
|
||||
}
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Get_AlarmType
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>: <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
0:<3A><><EFBFBD><EFBFBD>
|
||||
1:sensor - err
|
||||
2:<3A><><EFBFBD><EFBFBD>
|
||||
3:<3A><>ѹ
|
||||
*******************************************************************************/
|
||||
u8 Get_AlarmType(void) {
|
||||
return gAlarm_type;
|
||||
}
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Set_AlarmType
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><><EFBFBD>ñ<EFBFBD><C3B1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
0:<3A><><EFBFBD><EFBFBD>
|
||||
1:sen - err
|
||||
2:<3A><><EFBFBD><EFBFBD>
|
||||
3:<3A><>ѹ
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Set_AlarmType(u8 type) {
|
||||
gAlarm_type = type;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Read_Vb
|
||||
Description:Reads the input voltage and compares it to the thresholds??
|
||||
Input:Selects which threshold we are comparing to
|
||||
Output:Returns a key for if the voltage is in spec (I think)
|
||||
*******************************************************************************/
|
||||
int Read_Vb(u8 flag) {
|
||||
u32 tmp, i, sum = 0;
|
||||
|
||||
for (i = 0; i < 10; i++) {
|
||||
tmp = ADC_GetConversionValue(ADC2);
|
||||
sum += tmp;
|
||||
}
|
||||
tmp = sum / 10;
|
||||
if (tmp >= (gVol[0] + gVol[0] / 100)) {
|
||||
gAlarm_type = HIGH_VOLTAGE;
|
||||
return H_ALARM; //<2F><><EFBFBD><EFBFBD>3500
|
||||
}
|
||||
tmp = (tmp * 10 / 144); //<2F><>ѹvb = 3.3 * 85 *ad / 40950
|
||||
|
||||
for (i = 0; i < 4; i++) {
|
||||
if (i == 2) {
|
||||
if (flag == 0) {
|
||||
if (tmp >= gRate[i])
|
||||
break;
|
||||
} else {
|
||||
if (tmp >= gTurn_offv)
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
if (tmp >= gRate[i])
|
||||
break;
|
||||
}
|
||||
}
|
||||
return (i + 1);
|
||||
}
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Scan_Key
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:ɨ<><C9A8><EFBFBD><EFBFBD><EFBFBD>(50msÿ<73><C3BF>)
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Scan_Key(void) {
|
||||
static u32 p_cnt = 0, key_statuslast = 0;
|
||||
u32 key_state = 0;
|
||||
|
||||
if ((~GPIOA->IDR) & 0x0200)
|
||||
key_state |= KEY_V1; //KEY_V1
|
||||
if ((~GPIOA->IDR) & 0x0040)
|
||||
key_state |= KEY_V2; //KEY_V2
|
||||
|
||||
if (key_state == 0)
|
||||
return;
|
||||
|
||||
if (gLongkey_flag == 1) { //LongKey_flag :<3A><><EFBFBD>Ƴ<EFBFBD><C6B3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>־
|
||||
if (key_statuslast == key_state) {
|
||||
p_cnt++;
|
||||
if (p_cnt > 21)
|
||||
Set_gKey(KEY_CN | key_state); //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
} else {
|
||||
p_cnt = 0;
|
||||
key_statuslast = key_state;
|
||||
Set_gKey(key_state);
|
||||
}
|
||||
} else {
|
||||
p_cnt = 0;
|
||||
key_statuslast = key_state;
|
||||
Set_gKey(key_state);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Get_SlAvg
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>ֵ
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:avg_data ƽ<><C6BD><EFBFBD><EFBFBD>ADֵ
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:<3A><><EFBFBD><EFBFBD>ƽ<EFBFBD><C6BD>ֵ
|
||||
*******************************************************************************/
|
||||
u32 Get_SlAvg(u32 avg_data) {
|
||||
static u32 sum_avg = 0;
|
||||
static u8 init_flag = 0;
|
||||
u16 si_avg = sum_avg / SI_COE, abs;
|
||||
|
||||
if (init_flag == 0) { /*<2A><>һ<EFBFBD><D2BB><EFBFBD>ϵ<EFBFBD>*/
|
||||
sum_avg = SI_COE * avg_data;
|
||||
init_flag = 1;
|
||||
return sum_avg / SI_COE;
|
||||
}
|
||||
if (avg_data > si_avg)
|
||||
abs = avg_data - si_avg;
|
||||
else
|
||||
abs = si_avg - avg_data;
|
||||
|
||||
if (abs > SI_THRESHOLD)
|
||||
sum_avg = SI_COE * avg_data;
|
||||
else
|
||||
sum_avg += avg_data - sum_avg / SI_COE;
|
||||
|
||||
return sum_avg / SI_COE;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description: Read the thermocouple in the soldering iron head
|
||||
Output:Soldering Iron temperature
|
||||
*******************************************************************************/
|
||||
u32 Get_AvgAd(void) {
|
||||
/*The head has a thermocouple inline with the heater
|
||||
This is read by turning off the heater
|
||||
Then read the output of the op-amp that is connected across the connections
|
||||
*/
|
||||
static u32 ad_sum = 0;
|
||||
static u32 max = 0, min = 5000;
|
||||
u32 ad_value, avg_data, slide_data = 0;
|
||||
|
||||
Set_HeatingTime(0); //set the remaining time to zero
|
||||
HEAT_OFF(); //heater must be off
|
||||
Delay_HalfMs(25); //wait for the heater to time out
|
||||
gMeas_cnt = 10; //how many measurements to make
|
||||
|
||||
while (gMeas_cnt > 0) {
|
||||
ad_value = Get_AdcValue(0); //Read_Tmp();
|
||||
ad_sum += ad_value;
|
||||
if (ad_value > max)
|
||||
max = ad_value;
|
||||
if (ad_value < min)
|
||||
min = ad_value;
|
||||
|
||||
if (gMeas_cnt == 1) { //We have just taken the last reading
|
||||
ad_sum = ad_sum - max - min; //remove the two outliers
|
||||
avg_data = ad_sum / 8; //take the average
|
||||
|
||||
slide_data = Get_SlAvg(avg_data);
|
||||
ad_sum = 0;
|
||||
min = 5000;
|
||||
max = 0;
|
||||
}
|
||||
gMeas_cnt--;
|
||||
}
|
||||
return slide_data; //gSlide_data;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description:
|
||||
*******************************************************************************/
|
||||
int Get_TempSlAvg(int avg_data) {
|
||||
static int sum_avg = 0;
|
||||
static u8 init_flag = 0;
|
||||
|
||||
if (init_flag == 0) {
|
||||
sum_avg = 8 * avg_data;
|
||||
init_flag = 1;
|
||||
return sum_avg / 8;
|
||||
}
|
||||
|
||||
sum_avg += avg_data - sum_avg / 8;
|
||||
|
||||
return sum_avg / 8;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description:Reads the temperature of the on board temp sensor for calibration
|
||||
http://www.analog.com/media/en/technical-documentation/data-sheets/TMP35_36_37.pdf
|
||||
Output: The onboardTemp in C
|
||||
*******************************************************************************/
|
||||
int Get_SensorTmp(void) {
|
||||
u32 ad_sum = 0;
|
||||
u32 max = 0, min = 5000;
|
||||
u32 ad_value, avg_data, slide_data;
|
||||
int sensor_temp = 0;
|
||||
|
||||
gMeas_cnt = 10;
|
||||
|
||||
while (gMeas_cnt > 0) {
|
||||
ad_value = Get_AdcValue(1);
|
||||
ad_sum += ad_value;
|
||||
if (ad_value > max)
|
||||
max = ad_value;
|
||||
if (ad_value < min)
|
||||
min = ad_value;
|
||||
|
||||
if (gMeas_cnt == 1) {
|
||||
ad_sum = ad_sum - max - min;
|
||||
avg_data = ad_sum / 8;
|
||||
//^ Removes the two outliers from the data spread
|
||||
slide_data = Get_TempSlAvg(avg_data);
|
||||
sensor_temp = (250 + (3300 * slide_data / 4096) - 750); //(25 + ((10*(33*gSlide_data)/4096)-75));
|
||||
//^ Convert the reading to C
|
||||
ad_sum = 0;
|
||||
min = 5000;
|
||||
max = 0;
|
||||
}
|
||||
gMeas_cnt--;
|
||||
}
|
||||
return sensor_temp;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description: Reads the Zero Temp.. And does something..
|
||||
*******************************************************************************/
|
||||
void Zero_Calibration(void) {
|
||||
u32 zerop;
|
||||
int cool_tmp;
|
||||
|
||||
zerop = Get_AvgAd(); //get the current
|
||||
cool_tmp = Get_SensorTmp(); //get the temp of the onboard sensor
|
||||
|
||||
if (zerop >= 400) { //If the tip is too hot abort
|
||||
gCalib_flag = 2;
|
||||
} else {
|
||||
if (cool_tmp < 300) { //If cool temp is cool enough continue
|
||||
gZerop_ad = zerop; //store the zero point
|
||||
gCalib_flag = 1;
|
||||
} else { //abort if too warm
|
||||
gCalib_flag = 2;
|
||||
}
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Get_Temp
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>,<2C>ȶ<EFBFBD><C8B6>¶<EFBFBD>,<2C><><EFBFBD><EFBFBD>AD<41><44><EFBFBD><EFBFBD><EFBFBD>¶<EFBFBD>
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:wk_temp <20><><EFBFBD><EFBFBD><EFBFBD>¶<EFBFBD>
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:ʵ<><CAB5><EFBFBD>¶<EFBFBD>
|
||||
*******************************************************************************/
|
||||
s16 Get_Temp(s16 wk_temp) {
|
||||
int ad_value, cool_tmp, compensation = 0;
|
||||
static u16 cnt = 0, h_cnt = 0;
|
||||
|
||||
ad_value = Get_AvgAd();
|
||||
cool_tmp = Get_SensorTmp();
|
||||
|
||||
if (ad_value == 4095)
|
||||
h_cnt++;
|
||||
else {
|
||||
h_cnt = 0;
|
||||
if (ad_value > 3800 && ad_value < 4095)
|
||||
cnt++;
|
||||
else
|
||||
cnt = 0;
|
||||
}
|
||||
if (h_cnt >= 60 && cnt == 0)
|
||||
gAlarm_type = SEN_ERR; //Sensor error -- too many invalid readings
|
||||
if (h_cnt == 0 && cnt >= 10)
|
||||
gAlarm_type = HIGH_TEMP; //Stuck at a really high temp -> Has mosfet failed
|
||||
if (h_cnt < 60 && cnt < 10)
|
||||
gAlarm_type = NORMAL_TEMP; //No errors so far
|
||||
|
||||
compensation = 80 + 150 * (wk_temp - 1000) / 3000;
|
||||
if (wk_temp == 1000)
|
||||
compensation -= 10;
|
||||
|
||||
if (wk_temp != 0) {
|
||||
if (ad_value > (compensation + gZerop_ad))
|
||||
ad_value -= compensation;
|
||||
}
|
||||
if (cool_tmp > 400)
|
||||
cool_tmp = 400; //cap cool temp at 40C
|
||||
|
||||
return (ad_value * 1000 + 806 * cool_tmp - gZerop_ad * 1000) / 806;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:Start_Watchdog
|
||||
Description: Starts the system watchdog timer
|
||||
*******************************************************************************/
|
||||
u32 Start_Watchdog(u32 ms) {
|
||||
IWDG_WriteAccessCmd(IWDG_WriteAccess_Enable);
|
||||
|
||||
/* IWDG counter clock: 40KHz(LSI) / 32 = 1.25 KHz (min:0.8ms -- max:3276.8ms */
|
||||
IWDG_SetPrescaler(IWDG_Prescaler_32);
|
||||
|
||||
/* Set counter reload value to XXms */
|
||||
IWDG_SetReload(ms * 10 / 8);
|
||||
|
||||
/* Reload IWDG counter */
|
||||
IWDG_ReloadCounter();
|
||||
|
||||
/* Enable IWDG (the LSI oscillator will be enabled by hardware) */
|
||||
IWDG_Enable();
|
||||
return 1;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:Clear_Watchdog
|
||||
Description:Resets the watchdog timer
|
||||
*******************************************************************************/
|
||||
void Clear_Watchdog(void) {
|
||||
IWDG_ReloadCounter();
|
||||
|
||||
}
|
||||
/******************************** END OF FILE *********************************/
|
||||
@@ -1,229 +1,148 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. **********************
|
||||
File Name : I2C.c
|
||||
Version : S100 APP Ver 2.11
|
||||
Description:
|
||||
Author : Celery
|
||||
Data: 2015/07/20
|
||||
History:
|
||||
2015/07/07 ͳһ<CDB3><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
2015/07/21 I2C_DELAYTIME = 2;
|
||||
*******************************************************************************/
|
||||
|
||||
#include "stm32f10x.h"
|
||||
/*
|
||||
* I2C.h hardware interface class
|
||||
* Based on the STM32 app note AN2824
|
||||
*/
|
||||
#include "I2C.h"
|
||||
#include "Bios.h"
|
||||
#include "Oled.h"
|
||||
#include "S100V0_1.h"
|
||||
|
||||
// --------- <20><><EFBFBD><EFBFBD>I2C<32>ӿ<EFBFBD><D3BF><EFBFBD>ض<EFBFBD><D8B6><EFBFBD>-------- //
|
||||
#define SDA GPIO_Pin_7
|
||||
#define SCL GPIO_Pin_6
|
||||
/*
|
||||
* Configure the I2C port hardware
|
||||
*/
|
||||
void I2C_Configuration(void) {
|
||||
GPIO_InitTypeDef GPIO_InitStructure;
|
||||
I2C_InitTypeDef I2C_InitStructure;
|
||||
|
||||
#define HIGH 1
|
||||
#define LOW 0
|
||||
/* PB6,7 SCL and SDA */
|
||||
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7;
|
||||
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_OD;
|
||||
GPIO_Init(GPIOB, &GPIO_InitStructure);
|
||||
|
||||
#define SDA_VAL GPIO_ReadInputDataBit(GPIOB, SDA)
|
||||
#define SCL_VAL GPIO_ReadInputDataBit(GPIOB, SCL)
|
||||
|
||||
#define I2C_MORE 1
|
||||
#define I2C_LAST 0
|
||||
#define I2C_TIMEOUT 255
|
||||
|
||||
#define FAILURE 0
|
||||
#define SUCCEED 1
|
||||
#define I2C_DELAYTIME 2
|
||||
|
||||
static void Sim_I2C_Set(u8 pin, u8 status);
|
||||
static void Sim_I2C_Stop(void);
|
||||
static void Sim_I2C_Start(void);
|
||||
static u8 Sim_I2C_RD_Byte(u8 more);
|
||||
static u8 Sim_I2C_WR_Byte(u8 data);
|
||||
|
||||
/*******************************************************************************
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Delay_uS
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: <20><><EFBFBD><EFBFBD><EFBFBD>ʱ
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:us
|
||||
<EFBFBD><EFBFBD><EFBFBD>ز<EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Delay_uS(u32 us)
|
||||
{
|
||||
while(us) us--;
|
||||
}
|
||||
/*******************************************************************************
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: I2C_Configuration
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: <20><><EFBFBD><EFBFBD>I2C
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
<EFBFBD><EFBFBD><EFBFBD>ز<EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void I2C_Configuration(void)
|
||||
{
|
||||
GPIO_InitTypeDef GPIO_InitStructure;
|
||||
I2C_InitTypeDef I2C_InitStructure;
|
||||
|
||||
GPIO_Init_OLED();
|
||||
/* PB6,7 SCL and SDA */
|
||||
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7;
|
||||
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_OD;
|
||||
GPIO_Init(GPIOB, &GPIO_InitStructure);
|
||||
|
||||
/* I2C1 configuration ------------------------------------------------------*/
|
||||
I2C_InitStructure.I2C_Mode = I2C_Mode_I2C;
|
||||
I2C_InitStructure.I2C_DutyCycle = I2C_DutyCycle_2;
|
||||
I2C_InitStructure.I2C_OwnAddress1 = DEVICEADDR_OLED;
|
||||
I2C_InitStructure.I2C_Ack = I2C_Ack_Enable;
|
||||
I2C_InitStructure.I2C_AcknowledgedAddress = I2C_AcknowledgedAddress_7bit;
|
||||
I2C_InitStructure.I2C_ClockSpeed = 100000;//100k
|
||||
I2C_Init(I2C1, &I2C_InitStructure);
|
||||
I2C_Cmd(I2C1, ENABLE);
|
||||
/* I2C1 configuration ------------------------------------------------------*/
|
||||
I2C_InitStructure.I2C_Mode = I2C_Mode_I2C;
|
||||
I2C_InitStructure.I2C_DutyCycle = I2C_DutyCycle_2;
|
||||
I2C_InitStructure.I2C_Ack = I2C_Ack_Enable;
|
||||
I2C_InitStructure.I2C_AcknowledgedAddress = I2C_AcknowledgedAddress_7bit;
|
||||
I2C_InitStructure.I2C_ClockSpeed = 100000; //100k
|
||||
I2C_Init(I2C1, &I2C_InitStructure);
|
||||
I2C_Cmd(I2C1, ENABLE);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: I2C_Configuration
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: <20><><EFBFBD><EFBFBD>I2C
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
<EFBFBD><EFBFBD><EFBFBD>ز<EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Sim_I2C_Set(u8 pin, u8 status)
|
||||
{
|
||||
if(status == HIGH) GPIO_SetBits (GPIOB, pin);
|
||||
if(status == LOW) GPIO_ResetBits(GPIOB, pin);
|
||||
}
|
||||
/*******************************************************************************
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Sim_I2C_Start
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: <20><>ʼ
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
<EFBFBD><EFBFBD><EFBFBD>ز<EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Sim_I2C_Start(void)
|
||||
{
|
||||
GPIO_InitTypeDef GPIO_InitStructure;
|
||||
/*
|
||||
* Writes a page of data over I2C using the I2C1 peripheral in the stm32
|
||||
*
|
||||
*/
|
||||
void I2C_PageWrite(u8* buf, u8 nbyte, u8 deviceaddr) {
|
||||
|
||||
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE); // I2C_PIN_EN();
|
||||
GPIO_InitStructure.GPIO_Pin = SCL | SDA;
|
||||
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_OD;
|
||||
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
|
||||
GPIO_Init (GPIOB, &GPIO_InitStructure);
|
||||
while (I2C_GetFlagStatus(I2C1, I2C_FLAG_BUSY)) {
|
||||
}
|
||||
// Intiate Start Sequence
|
||||
I2C_GenerateSTART(I2C1, ENABLE);
|
||||
while (!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_MODE_SELECT)) {
|
||||
}
|
||||
// Send Address
|
||||
I2C_Send7bitAddress(I2C1, deviceaddr << 1, I2C_Direction_Transmitter);
|
||||
while (!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_TRANSMITTER_MODE_SELECTED)) {
|
||||
}
|
||||
// Write first byte EV8_1
|
||||
I2C_SendData(I2C1, *buf++);
|
||||
|
||||
Sim_I2C_Set(SCL, LOW); // SCL low
|
||||
Sim_I2C_Set(SDA, HIGH); // SDA float, set as output high
|
||||
Sim_I2C_Set(SCL, HIGH); // SCL high
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
Sim_I2C_Set(SDA, LOW); // SDA high->low while sclk high, S state occur...
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
Sim_I2C_Set(SCL, LOW); // SCL low
|
||||
}
|
||||
/*******************************************************************************
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Sim_I2C_Stop
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: ֹͣ
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
<EFBFBD><EFBFBD><EFBFBD>ز<EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Sim_I2C_Stop(void)
|
||||
{
|
||||
Sim_I2C_Set(SCL, LOW); // SCL low
|
||||
Sim_I2C_Set(SDA, LOW); // SDA low
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
Sim_I2C_Set(SCL, HIGH); // SCL high
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
Sim_I2C_Set(SDA, HIGH); // SDA low->high while sclk high, P state occur
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
Sim_I2C_Set(SCL, LOW); // SCL low
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
}
|
||||
/*******************************************************************************
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Sim_I2C_WR_Byte
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>I2Cд<43><D0B4>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:dataҪд<D2AA><D0B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
<EFBFBD><EFBFBD><EFBFBD>ز<EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
u8 Sim_I2C_WR_Byte(u8 data)
|
||||
{
|
||||
u8 i = 8;
|
||||
while (--nbyte) {
|
||||
// wait on BTF
|
||||
while (!I2C_GetFlagStatus(I2C1, I2C_FLAG_BTF)) {
|
||||
}
|
||||
I2C_SendData(I2C1, *buf++);
|
||||
}
|
||||
|
||||
while(i--) { //send out a bit by sda line.
|
||||
Sim_I2C_Set(SCL, LOW); // sclk low
|
||||
if(data & 0x80) Sim_I2C_Set(SDA, HIGH); // send bit is 1
|
||||
else Sim_I2C_Set(SDA, LOW); // send bit is 0
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
Sim_I2C_Set(SCL, HIGH); // SCL high
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
data <<=1; // left shift 1 bit, MSB send first.
|
||||
}
|
||||
Sim_I2C_Set(SCL, LOW); // SCL low
|
||||
Sim_I2C_Set(SDA, HIGH); // SDA set as input
|
||||
for(i=I2C_TIMEOUT; i!=0; i--) { // wait for sda low to receive ack
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
if (!SDA_VAL) {
|
||||
Sim_I2C_Set(SCL, HIGH); // SCL high
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
Sim_I2C_Set(SCL, LOW); // SCL_LOW();
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
return SUCCEED;
|
||||
}
|
||||
}
|
||||
return FAILURE;
|
||||
}
|
||||
/*******************************************************************************
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Sim_I2C_RD_Byte
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>I2C<32><43><EFBFBD><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:more
|
||||
<EFBFBD><EFBFBD><EFBFBD>ز<EFBFBD><EFBFBD><EFBFBD>:<3A><><EFBFBD><EFBFBD><EFBFBD>İ<EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
|
||||
*******************************************************************************/
|
||||
u8 Sim_I2C_RD_Byte(u8 more)
|
||||
{
|
||||
u8 i = 8, byte = 0;
|
||||
while (!I2C_GetFlagStatus(I2C1, I2C_FLAG_BTF)) {
|
||||
}
|
||||
I2C_GenerateSTOP(I2C1, ENABLE);
|
||||
while (I2C_GetFlagStatus(I2C1, I2C_FLAG_STOPF)) {
|
||||
}
|
||||
|
||||
Sim_I2C_Set(SDA, HIGH); // SDA set as input
|
||||
while(i--) {
|
||||
Sim_I2C_Set(SCL, LOW); // SCL low
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
Sim_I2C_Set(SCL, HIGH); // SCL high
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
byte <<=1; //recv a bit
|
||||
if (SDA_VAL) byte |= 0x01;
|
||||
}
|
||||
Sim_I2C_Set(SCL, LOW);
|
||||
if(!more) Sim_I2C_Set(SDA, HIGH); //last byte, send nack.
|
||||
else Sim_I2C_Set(SDA, LOW); //send ack
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
Sim_I2C_Set(SCL, HIGH); // SCL_HIGH();
|
||||
Delay_uS(I2C_DELAYTIME);
|
||||
Sim_I2C_Set(SCL, LOW);
|
||||
return byte;
|
||||
}
|
||||
/*******************************************************************************
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: I2C_PageWrite
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><> <20><>ַ deviceaddr д<><D0B4>numbyte<74><65><EFBFBD>ֽڵ<D6BD><DAB5><EFBFBD><EFBFBD>ݣ<EFBFBD>д<EFBFBD><D0B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>pbuf
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:pbuf д<><D0B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݣ<EFBFBD>numbyte Ϊд<CEAA><D0B4><EFBFBD><EFBFBD>ֽ<EFBFBD><D6BD><EFBFBD><EFBFBD><EFBFBD>deviceaddrΪд<CEAA><D0B4>ĵ<EFBFBD>ַ
|
||||
<EFBFBD><EFBFBD><EFBFBD>ز<EFBFBD><EFBFBD><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void I2C_PageWrite(u8* pbuf, u8 numbyte,u8 deviceaddr )
|
||||
{
|
||||
Sim_I2C_Start();
|
||||
Sim_I2C_WR_Byte(deviceaddr<<1);
|
||||
while(numbyte--) Sim_I2C_WR_Byte(*pbuf++);
|
||||
Sim_I2C_Stop();
|
||||
}
|
||||
/*******************************************************************************
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: I2C_PageRead
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>I2C<32><43><EFBFBD><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
|
||||
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: pbuf <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ĵ<EFBFBD>ŵ<EFBFBD>ַ numbyteΪ<65><CEAA><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֽ<EFBFBD><D6BD><EFBFBD>
|
||||
deviceaddr<64>豸<EFBFBD><E8B1B8>ַ readaddr<64><72>ȡ<EFBFBD><C8A1><EFBFBD><EFBFBD><EFBFBD>ݵ<EFBFBD>ַ
|
||||
<EFBFBD><EFBFBD><EFBFBD>ز<EFBFBD><EFBFBD><EFBFBD>:<3A><><EFBFBD><EFBFBD><EFBFBD>İ<EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
|
||||
*******************************************************************************/
|
||||
void I2C_PageRead(u8* pbuf, u8 numbyte,u8 deviceaddr, u8 readaddr)
|
||||
{
|
||||
Sim_I2C_Start();
|
||||
Sim_I2C_WR_Byte(deviceaddr<<1);
|
||||
Sim_I2C_WR_Byte(readaddr);
|
||||
Sim_I2C_Start();
|
||||
Sim_I2C_WR_Byte((deviceaddr<<1)|1);
|
||||
|
||||
while(numbyte--) {
|
||||
if(numbyte) *pbuf++ = Sim_I2C_RD_Byte(I2C_MORE);
|
||||
else *pbuf++ = Sim_I2C_RD_Byte(I2C_LAST);
|
||||
}
|
||||
Sim_I2C_Stop();
|
||||
/*
|
||||
* Read Page of data using I2C1 peripheral
|
||||
*/
|
||||
|
||||
void I2C_PageRead(u8* buf, u8 nbyte, u8 deviceaddr, u8 readaddr) {
|
||||
I2C_GenerateSTART(I2C1, ENABLE);
|
||||
while (I2C_GetFlagStatus(I2C1, I2C_FLAG_SB) == RESET)
|
||||
;
|
||||
I2C_Send7bitAddress(I2C1, deviceaddr << 1, I2C_Direction_Transmitter);
|
||||
while (I2C_GetFlagStatus(I2C1, I2C_FLAG_ADDR) == RESET)
|
||||
;
|
||||
I2C_GetFlagStatus(I2C1, I2C_FLAG_MSL);
|
||||
while (I2C_GetFlagStatus(I2C1, I2C_FLAG_TXE) == RESET)
|
||||
;
|
||||
// Send an 8bit byte address
|
||||
I2C_SendData(I2C1, readaddr);
|
||||
while (I2C_GetFlagStatus(I2C1, I2C_FLAG_BUSY)) {
|
||||
}
|
||||
I2C_AcknowledgeConfig(I2C1, DISABLE);
|
||||
I2C_NACKPositionConfig(I2C1, I2C_NACKPosition_Current);
|
||||
I2C_GenerateSTART(I2C1, ENABLE);
|
||||
while (!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_MODE_SELECT)) {
|
||||
}
|
||||
I2C_Send7bitAddress(I2C1, deviceaddr << 1, I2C_Direction_Receiver);
|
||||
while (!I2C_GetFlagStatus(I2C1, I2C_FLAG_ADDR)) {
|
||||
}
|
||||
if (nbyte == 1) {
|
||||
// Clear Ack bit
|
||||
I2C_AcknowledgeConfig(I2C1, DISABLE);
|
||||
// EV6_1 -- must be atomic -- Clear ADDR, generate STOP
|
||||
__disable_irq();
|
||||
(void) I2C1->SR2;
|
||||
I2C_GenerateSTOP(I2C1, ENABLE);
|
||||
__enable_irq();
|
||||
// Receive data EV7
|
||||
while (!I2C_GetFlagStatus(I2C1, I2C_FLAG_RXNE)) {
|
||||
}
|
||||
*buf++ = I2C_ReceiveData(I2C1);
|
||||
} else if (nbyte == 2) {
|
||||
// Set POS flag
|
||||
I2C_NACKPositionConfig(I2C1, I2C_NACKPosition_Next);
|
||||
// EV6_1 -- must be atomic and in this order
|
||||
__disable_irq();
|
||||
(void) I2C1->SR2; // Clear ADDR flag
|
||||
I2C_AcknowledgeConfig(I2C1, DISABLE); // Clear Ack bit
|
||||
__enable_irq();
|
||||
// EV7_3 -- Wait for BTF, program stop, read data twice
|
||||
while (!I2C_GetFlagStatus(I2C1, I2C_FLAG_BTF)) {
|
||||
}
|
||||
__disable_irq();
|
||||
I2C_GenerateSTOP(I2C1, ENABLE);
|
||||
*buf++ = I2C1->DR;
|
||||
__enable_irq();
|
||||
*buf++ = I2C1->DR;
|
||||
} else {
|
||||
(void) I2C1->SR2; // Clear ADDR flag
|
||||
while (nbyte-- != 3) {
|
||||
// EV7 -- cannot guarantee 1 transfer completion time, wait for BTF
|
||||
// instead of RXNE
|
||||
while (!I2C_GetFlagStatus(I2C1, I2C_FLAG_BTF)) {
|
||||
}
|
||||
*buf++ = I2C_ReceiveData(I2C1);
|
||||
}
|
||||
|
||||
while (!I2C_GetFlagStatus(I2C1, I2C_FLAG_BTF)) {
|
||||
}
|
||||
// EV7_2 -- Figure 1 has an error, doesn't read N-2 !
|
||||
I2C_AcknowledgeConfig(I2C1, DISABLE); // clear ack bit
|
||||
__disable_irq();
|
||||
*buf++ = I2C_ReceiveData(I2C1); // receive byte N-2
|
||||
I2C_GenerateSTOP(I2C1, ENABLE); // program stop
|
||||
__enable_irq();
|
||||
*buf++ = I2C_ReceiveData(I2C1); // receive byte N-1
|
||||
// wait for byte N
|
||||
while (!I2C_CheckEvent(I2C1, I2C_EVENT_MASTER_BYTE_RECEIVED)) {
|
||||
}
|
||||
*buf++ = I2C_ReceiveData(I2C1);
|
||||
nbyte = 0;
|
||||
}
|
||||
// Wait for stop
|
||||
while (I2C_GetFlagStatus(I2C1, I2C_FLAG_STOPF)) {
|
||||
}
|
||||
return;
|
||||
}
|
||||
/******************************** END OF FILE *********************************/
|
||||
|
||||
|
||||
@@ -1,14 +1,18 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. *******************/
|
||||
/* Brief : Interrupt Service Routines Author : bure */
|
||||
/******************************************************************************/
|
||||
#include "Interrupt.h"
|
||||
#include "usb_istr.h"
|
||||
#include "Bios.h"
|
||||
#include "I2C.h"
|
||||
|
||||
/******************************************************************************/
|
||||
/* Processor Exceptions Handlers */
|
||||
/******************************************************************************/
|
||||
volatile uint32_t system_Ticks;
|
||||
volatile uint32_t lastKeyPress; //millis() at the last button event
|
||||
volatile uint16_t keyState; //tracks the button status
|
||||
volatile uint32_t lastMovement; //millis() at last movement event
|
||||
|
||||
//Delay in milliseconds using systemTick
|
||||
void delayMs(uint32_t ticks) {
|
||||
uint32_t endtime = ticks + millis();
|
||||
while (millis() < endtime)
|
||||
;
|
||||
}
|
||||
|
||||
void NMI_Handler(void) {
|
||||
;
|
||||
@@ -34,6 +38,160 @@ void UsageFault_Handler(void) {
|
||||
;
|
||||
}
|
||||
|
||||
//Handles the tick of the sysTick events
|
||||
void SysTick_Handler(void) {
|
||||
++system_Ticks;
|
||||
}
|
||||
|
||||
/*Peripheral Interrupts */
|
||||
|
||||
void TIM3_IRQHandler(void) {
|
||||
TIM3_ISR();
|
||||
}
|
||||
|
||||
//EXTI IRQ handler
|
||||
//used for buttons and movement
|
||||
void EXTI9_5_IRQHandler(void) {
|
||||
//we are interested in line 9 and line 6 for buttons
|
||||
//Lien 5 == movement
|
||||
if (EXTI_GetITStatus(EXTI_Line9) != RESET) {
|
||||
if (GPIO_ReadInputDataBit(GPIOA, KEY_A) == SET)
|
||||
keyState &= ~(BUT_A);
|
||||
else
|
||||
keyState |= BUT_A;
|
||||
lastKeyPress = millis();
|
||||
EXTI_ClearITPendingBit(EXTI_Line9);
|
||||
} else if (EXTI_GetITStatus(EXTI_Line6) != RESET) {
|
||||
if (GPIO_ReadInputDataBit(GPIOA, KEY_B) == SET)
|
||||
keyState &= ~(BUT_B);
|
||||
else
|
||||
keyState |= BUT_B;
|
||||
lastKeyPress = millis();
|
||||
EXTI_ClearITPendingBit(EXTI_Line6);
|
||||
} else if (EXTI_GetITStatus(EXTI_Line5) != RESET) { //Movement Event
|
||||
lastMovement = millis();
|
||||
EXTI_ClearITPendingBit(EXTI_Line5);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
/*********************** UNUSED IRQ *****************************************/
|
||||
void WWDG_IRQHandler(void) {
|
||||
}
|
||||
void PVD_IRQHandler(void) {
|
||||
}
|
||||
void TAMPER_IRQHandler(void) {
|
||||
}
|
||||
void RTC_IRQHandler(void) {
|
||||
}
|
||||
void FLASH_IRQHandler(void) {
|
||||
}
|
||||
void RCC_IRQHandler(void) {
|
||||
}
|
||||
void EXTI0_IRQHandler(void) {
|
||||
}
|
||||
void EXTI1_IRQHandler(void) {
|
||||
}
|
||||
void EXTI2_IRQHandler(void) {
|
||||
}
|
||||
void EXTI3_IRQHandler(void) {
|
||||
}
|
||||
void EXTI4_IRQHandler(void) {
|
||||
}
|
||||
void DMA1_Channel1_IRQHandler(void) {
|
||||
}
|
||||
void DMA1_Channel2_IRQHandler(void) {
|
||||
}
|
||||
void DMA1_Channel3_IRQHandler(void) {
|
||||
}
|
||||
void DMA1_Channel4_IRQHandler(void) {
|
||||
}
|
||||
void DMA1_Channel5_IRQHandler(void) {
|
||||
}
|
||||
void DMA1_Channel6_IRQHandler(void) {
|
||||
}
|
||||
void DMA1_Channel7_IRQHandler(void) {
|
||||
}
|
||||
void ADC1_2_IRQHandler(void) {
|
||||
}
|
||||
void USB_HP_CAN1_TX_IRQHandler(void) {
|
||||
}
|
||||
void CAN1_RX1_IRQHandler(void) {
|
||||
}
|
||||
void CAN1_SCE_IRQHandler(void) {
|
||||
}
|
||||
|
||||
void TIM1_BRK_IRQHandler(void) {
|
||||
}
|
||||
void TIM1_UP_IRQHandler(void) {
|
||||
}
|
||||
void TIM1_TRG_COM_IRQHandler(void) {
|
||||
}
|
||||
void TIM1_CC_IRQHandler(void) {
|
||||
}
|
||||
void TIM4_IRQHandler(void) {
|
||||
}
|
||||
void I2C1_EV_IRQHandler(void) {
|
||||
}
|
||||
void I2C1_ER_IRQHandler(void) {
|
||||
}
|
||||
void I2C2_EV_IRQHandler(void) {
|
||||
}
|
||||
void I2C2_ER_IRQHandler(void) {
|
||||
}
|
||||
void SPI1_IRQHandler(void) {
|
||||
}
|
||||
void SPI2_IRQHandler(void) {
|
||||
}
|
||||
void USART1_IRQHandler(void) {
|
||||
}
|
||||
void USART2_IRQHandler(void) {
|
||||
}
|
||||
void USART3_IRQHandler(void) {
|
||||
}
|
||||
void EXTI15_10_IRQHandler(void) {
|
||||
}
|
||||
void RTCAlarm_IRQHandler(void) {
|
||||
}
|
||||
void USBWakeUp_IRQHandler(void) {
|
||||
}
|
||||
void TIM8_BRK_IRQHandler(void) {
|
||||
}
|
||||
void TIM8_UP_IRQHandler(void) {
|
||||
}
|
||||
void TIM8_TRG_COM_IRQHandler(void) {
|
||||
}
|
||||
void TIM8_CC_IRQHandler(void) {
|
||||
}
|
||||
void ADC3_IRQHandler(void) {
|
||||
}
|
||||
void FSMC_IRQHandler(void) {
|
||||
}
|
||||
void SDIO_IRQHandler(void) {
|
||||
}
|
||||
void TIM5_IRQHandler(void) {
|
||||
}
|
||||
void SPI3_IRQHandler(void) {
|
||||
}
|
||||
void UART4_IRQHandler(void) {
|
||||
}
|
||||
void UART5_IRQHandler(void) {
|
||||
}
|
||||
void TIM6_IRQHandler(void) {
|
||||
}
|
||||
void TIM7_IRQHandler(void) {
|
||||
}
|
||||
void DMA2_Channel1_IRQHandler(void) {
|
||||
}
|
||||
void DMA2_Channel2_IRQHandler(void) {
|
||||
}
|
||||
void DMA2_Channel3_IRQHandler(void) {
|
||||
}
|
||||
void DMA2_Channel4_5_IRQHandler(void) {
|
||||
}
|
||||
void TIM2_IRQHandler(void) {
|
||||
|
||||
}
|
||||
void SVC_Handler(void) {
|
||||
}
|
||||
|
||||
@@ -43,33 +201,8 @@ void DebugMon_Handler(void) {
|
||||
void PendSV_Handler(void) {
|
||||
}
|
||||
|
||||
void SysTick_Handler(void) {
|
||||
}
|
||||
|
||||
/******************************************************************************/
|
||||
/* Peripherals Interrupt Handlers */
|
||||
/* Add here the Interrupt Handler for the used peripheral(s) (PPP), for the */
|
||||
/* available peripheral interrupt handler's name please refer to the startup */
|
||||
/* file (startup_stm32f30x.s). */
|
||||
/******************************************************************************/
|
||||
|
||||
void USB_LP_CAN1_RX0_IRQHandler(void) {
|
||||
USB_Istr();
|
||||
}
|
||||
void TIM2_IRQHandler(void) {
|
||||
TIM2_ISR();
|
||||
|
||||
}
|
||||
|
||||
void TIM3_IRQHandler(void) {
|
||||
TIM3_ISR();
|
||||
}
|
||||
/*This loop is used for un assigned IRQ's so that the debugger can catch them*/
|
||||
static void forever()
|
||||
|
||||
{
|
||||
for (;;)
|
||||
;
|
||||
}
|
||||
|
||||
/********************************* END OF FILE ******************************/
|
||||
|
||||
|
||||
@@ -1,252 +1,43 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. **********************
|
||||
File Name : MMA8652FC.c
|
||||
Version : S100 APP Ver 2.11
|
||||
Description:
|
||||
Author : Celery
|
||||
Data: 2015/07/07
|
||||
History:
|
||||
2016/09/13 Ben V. Brown - English comments and fixing a few errors
|
||||
2015/07/07 ͳһ<CDB3><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
*******************************************************************************/
|
||||
/*
|
||||
* MMA8652FC.*
|
||||
* Files for the built in accelerometer from NXP.
|
||||
* This sets the unit up in motion detection mode with an interrupt on movement
|
||||
* This interrupt is fed to PB5 which catches it via EXTI5
|
||||
*
|
||||
* http://cache.freescale.com/files/sensors/doc/data_sheet/MMA8652FC.pdf
|
||||
*
|
||||
* EXTI Motion config setup values lifted from AN4070from NXP
|
||||
*
|
||||
* Ben V. Brown - <ralim@ralimtek.com>
|
||||
*/
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include "APP_Version.h"
|
||||
#include "Bios.h"
|
||||
#include "Oled.h"
|
||||
#include "MMA8652FC.h"
|
||||
#include "I2C.h"
|
||||
#include "CTRL.h"
|
||||
#include "UI.h"
|
||||
//------------------------------------------------------------------//
|
||||
|
||||
static int IIC_RegWrite(u8 reg, u8 data);
|
||||
static int IIC_RegRead(u8 reg);
|
||||
static int Read_ZYXDr(void);
|
||||
|
||||
u16 gactive = 0, gShift = 0;
|
||||
u8 gMmatxdata;
|
||||
|
||||
typedef struct {
|
||||
u8 hi;
|
||||
u8 lo;
|
||||
|
||||
} DR_Value;
|
||||
|
||||
DR_Value gX_value, gY_value, gZ_value;
|
||||
|
||||
/*******************************************************************************
|
||||
Function:
|
||||
Description:Returns if the unit is actively being moved
|
||||
Output: if the unit is active or not.
|
||||
*******************************************************************************/
|
||||
u16 Get_MmaActive(void) {
|
||||
return gactive;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Get_MmaActive
|
||||
Description:Returns if movement has occured (0==still,1==movement)
|
||||
*******************************************************************************/
|
||||
u16 Get_MmaShift(void) {
|
||||
return gShift;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Set_MmaShift
|
||||
Description: Set the Shift Value
|
||||
Input: shift value
|
||||
*******************************************************************************/
|
||||
void Set_MmaShift(u16 shift) {
|
||||
gShift = shift;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:IIC_RegWrite
|
||||
Description:Writes a value to a register
|
||||
Input:the register, the data
|
||||
Output: 1 if the write succeeded
|
||||
*******************************************************************************/
|
||||
int IIC_RegWrite(u8 reg, u8 data) {
|
||||
u8 tx_data[20];
|
||||
|
||||
void I2C_RegisterWrite(uint8_t reg, uint8_t data) {
|
||||
u8 tx_data[2];
|
||||
tx_data[0] = reg;
|
||||
tx_data[1] = data;
|
||||
I2C_PageWrite(tx_data, 2, DEVICE_ADDR);
|
||||
return 1;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:IIC_RegRead
|
||||
Description: Reads a register from I2C, using a single byte addressing scheme
|
||||
Inputs: uint8_t register to read
|
||||
Output: 1 if the read worked.
|
||||
*******************************************************************************/
|
||||
int IIC_RegRead(u8 reg) {
|
||||
u8 tx_data[20];
|
||||
|
||||
uint8_t I2C_RegisterRead(uint8_t reg) {
|
||||
u8 tx_data[3];
|
||||
tx_data[0] = reg;
|
||||
|
||||
I2C_PageRead(tx_data, 1, DEVICE_ADDR, reg);
|
||||
gMmatxdata = tx_data[0];
|
||||
return 1;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: MMA865x_Standby
|
||||
Description: Put the MMA865 into standby mode
|
||||
*******************************************************************************/
|
||||
void MMA865x_Standby(void) {
|
||||
//Put the sensor into Standby Mode by clearing
|
||||
// the Active bit of the System Control 1 Register
|
||||
IIC_RegWrite(CTRL_REG1, 0); //(IIC_RegRead(CTRL_REG1) & ~ ACTIVE_MASK)
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: MMA865x_Active
|
||||
Description: Put the MMA865 into active mode
|
||||
*******************************************************************************/
|
||||
void MMA865x_Active(void) {
|
||||
// Put the sensor into Active Mode by setting the
|
||||
// Active bit of the System Control 1 Register
|
||||
IIC_RegWrite(CTRL_REG1, ACTIVE_MASK); //(IIC_RegRead(CTRL_REG1) | ACTIVE_MASK)
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: IIC_RegRead
|
||||
Description:Setup the MMA865x IC settings
|
||||
*******************************************************************************/
|
||||
void StartUp_Accelerated(void) {
|
||||
//Put the unit into standby state so we can edit its configuration registers
|
||||
MMA865x_Standby();
|
||||
//Set the unit to full scale measurement
|
||||
IIC_RegWrite(XYZ_DATA_CFG_REG, FULL_SCALE_8G); //(IIC_RegRead(XYZ_DATA_CFG_REG) & ~FS_MASK)
|
||||
//Set the unit to the required update rate (eg 100Hz)
|
||||
IIC_RegWrite(CTRL_REG1, DataRateValue); //IIC_RegRead(CTRL_REG1)|
|
||||
|
||||
IIC_RegWrite(CTRL_REG2, 0); //Normal mode
|
||||
|
||||
//Change the unit back to active mode to exit setup and start the readings
|
||||
MMA865x_Active();
|
||||
return tx_data[0];
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function: Read_ZYXDr
|
||||
Description:
|
||||
Output: 1 if new data, 0 if not
|
||||
*******************************************************************************/
|
||||
int Read_ZYXDr(void) {
|
||||
u8 reg_flag;
|
||||
u8 ptr, i;
|
||||
u8 value[6] = { 0, 0, 0, 0, 0, 0 };
|
||||
//Poll the ZYXDR status bit and wait for it to set
|
||||
if (IIC_RegRead(STATUS_REG)) { //check we can read the status
|
||||
reg_flag = gMmatxdata;
|
||||
if ((reg_flag & ZYXDR_BIT) != 0) { //if new measurement
|
||||
//Read 12/10-bit XYZ results using a 6 byte IIC access
|
||||
ptr = X_MSB_REG;
|
||||
for (i = 0; i < 6; i++) {
|
||||
if (IIC_RegRead(ptr++) == 0)
|
||||
break;
|
||||
void StartUp_Accelerometer(void) {
|
||||
I2C_RegisterWrite(CTRL_REG2, 0); //Normal mode
|
||||
I2C_RegisterWrite( CTRL_REG2, 0x40); // Reset all registers to POR values
|
||||
delayMs(2); // ~1ms delay
|
||||
I2C_RegisterWrite(FF_MT_CFG_REG, 0x78); // Enable motion detection for X and Y axis, latch enabled
|
||||
I2C_RegisterWrite(FF_MT_THS_REG, 0x0F); // Set threshold
|
||||
I2C_RegisterWrite(FF_MT_COUNT_REG, 0x01); // Set debounce to 100ms
|
||||
|
||||
value[i] = gMmatxdata;
|
||||
//Copy and save each result as a 16-bit left-justified value
|
||||
gX_value.hi = value[0];
|
||||
gX_value.lo = value[1];
|
||||
gY_value.hi = value[2];
|
||||
gY_value.lo = value[3];
|
||||
gZ_value.hi = value[4];
|
||||
gZ_value.lo = value[5];
|
||||
return 1;
|
||||
}
|
||||
} else
|
||||
return 0;
|
||||
}
|
||||
return 0;
|
||||
I2C_RegisterWrite( CTRL_REG4, 0x04); // Enable motion interrupt
|
||||
I2C_RegisterWrite( CTRL_REG5, 0x04);// Route motion interrupts to INT1 ->PB5 ->EXTI
|
||||
I2C_RegisterWrite( CTRL_REG1, 0x19); // ODR=100 Hz, Active mode
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Cheak_XYData
|
||||
Description: Check the input X,Y for a large enough acceleration to wake the unit
|
||||
Inputs:x0,y0,x1,y1 to check
|
||||
Output: if the unit is active
|
||||
*******************************************************************************/
|
||||
u16 Cheak_XYData(u16 x0, u16 y0, u16 x1, u16 y1) {
|
||||
u16 active = 0;
|
||||
gShift = 0;
|
||||
|
||||
if ((x1 > (x0 + 32)) || (x1 < (x0 - 32)))
|
||||
gShift = 1;
|
||||
if ((y1 > (y0 + 32)) || (y1 < (y0 - 32)))
|
||||
gShift = 1;
|
||||
|
||||
if ((x1 > (x0 + 16)) || (x1 < (x0 - 16)))
|
||||
active = 1;
|
||||
if ((y1 > (y0 + 16)) || (y1 < (y0 - 16)))
|
||||
active = 1;
|
||||
|
||||
return active;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Update_X
|
||||
Description: Converts the read value for x into an actual properly located value
|
||||
Output: X
|
||||
*******************************************************************************/
|
||||
u16 Update_X(void) {
|
||||
u16 value, x;
|
||||
|
||||
value = ((gX_value.hi << 8) | (gX_value.lo & 0xf0)) >> 4;
|
||||
if (gX_value.hi > 0x7f)
|
||||
x = (~value + 1) & 0xfff;
|
||||
else
|
||||
x = value & 0xfff;
|
||||
|
||||
return x;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Update_Y
|
||||
Description: Converts the read value for y into an actual properly located value
|
||||
Output: Y
|
||||
*******************************************************************************/
|
||||
u16 Update_Y(void) {
|
||||
u16 value, y;
|
||||
|
||||
value = ((gY_value.hi << 8) | (gY_value.lo & 0xf0)) >> 4;
|
||||
if (gY_value.hi > 0x7f)
|
||||
y = (~value + 1) & 0xfff;
|
||||
else
|
||||
y = value & 0xfff;
|
||||
|
||||
return y;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Update_Z
|
||||
Description: Converts the read value for z into an actual properly located value
|
||||
Output: Z
|
||||
*******************************************************************************/
|
||||
u16 Update_Z(void) {
|
||||
u16 value, z;
|
||||
|
||||
value = ((gZ_value.hi << 8) | (gZ_value.lo & 0xf0)) >> 4;
|
||||
if (gZ_value.hi > 0x7f)
|
||||
z = (~value + 1) & 0xfff;
|
||||
else
|
||||
z = value & 0xfff;
|
||||
|
||||
return z;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Check_Accelerated
|
||||
Description:Check if the unit has moved
|
||||
*******************************************************************************/
|
||||
void Check_Accelerated(void) {
|
||||
static u16 x0 = 0, y0 = 0;
|
||||
u16 x1, y1;
|
||||
|
||||
if (Read_ZYXDr()) { //Read the new values from the accelerometer
|
||||
x1 = Update_X(); //convert the values into usable form
|
||||
y1 = Update_Y();
|
||||
} else {
|
||||
x1 = x0;
|
||||
y1 = y0; //use old values
|
||||
gactive = 0;
|
||||
return;
|
||||
}
|
||||
|
||||
gactive = Cheak_XYData(x0, y0, x1, y1); //gactive == If the unit is moving or not
|
||||
|
||||
x0 = x1;
|
||||
y0 = y1;
|
||||
}
|
||||
/******************************** END OF FILE *********************************/
|
||||
|
||||
@@ -1,63 +1,41 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. **********************
|
||||
File Name : main.c
|
||||
Version : S100 APP Ver 2.11
|
||||
Description:
|
||||
Author : Celery
|
||||
Data: 2015/07/07
|
||||
History:
|
||||
2016/8/11 Updates by Ben V. Brown <ralim@ralimtek.com> - Cleanup and english comments
|
||||
2015/07/07 ͳһ<CDB3><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
*******************************************************************************/
|
||||
#include <string.h>
|
||||
#include <stdio.h>
|
||||
#include "APP_Version.h"
|
||||
#include "Disk.h"
|
||||
/*
|
||||
* Created by Ben V. Brown
|
||||
*/
|
||||
|
||||
#include "Modes.h"
|
||||
#include "Bios.h"
|
||||
#include "usb_lib.h"
|
||||
#include "I2C.h"
|
||||
#include "Flash.h"
|
||||
#include "MMA8652FC.h"
|
||||
#include "UI.h"
|
||||
#include "PID.h"
|
||||
#include "Oled.h"
|
||||
#include "CTRL.h"
|
||||
#include "Hardware.h"
|
||||
#include "Settings.h"
|
||||
#include "I2C.h"
|
||||
void setup();
|
||||
|
||||
int main(void) {
|
||||
RCC_Config(); //setup system clock
|
||||
NVIC_Config(0x4000);
|
||||
Init_Timer2(); //init the timers
|
||||
Init_Timer3();
|
||||
GPIO_Config();//setup all the GPIO pins
|
||||
|
||||
USB_Port(DISABLE);//disable the USB hardware
|
||||
Delay_Ms(200);//pause to let hardware stabilize
|
||||
USB_Port(ENABLE);//enable the USB hardware
|
||||
USB_Init();
|
||||
I2C_Configuration(); //init the i2c bus
|
||||
|
||||
Adc_Init(); //init adc and dma
|
||||
if (Get_CtrlStatus() != CONFIG)
|
||||
StartUp_Accelerated();//start the accelerometer if not in config mode
|
||||
|
||||
System_Init();//load known safe values
|
||||
Init_Oled();//init the OLED display
|
||||
Clear_Screen();//clear the display buffer to black
|
||||
Init_Gtime();//init the count down timers
|
||||
APP_Init();//pick operating mode via input voltage
|
||||
|
||||
Disk_BuffInit();//fill the buffer for the virtual disk
|
||||
Config_Analysis(); //read in config from virtual disk
|
||||
Pid_Init(); //init the pid to starting values
|
||||
Set_gKey(NO_KEY); //reset keys to all off
|
||||
Start_Watchdog(3000);//start the system watchdog as 3 seconds
|
||||
|
||||
setup();
|
||||
while (1) {
|
||||
Clear_Watchdog(); //reset the Watchdog
|
||||
if (Get_CtrlStatus() != CONFIG && LEAVE_WAIT_TIMER== 0) {
|
||||
Check_Accelerated(); //update readings from the accelerometer
|
||||
LEAVE_WAIT_TIMER = 50;//reset timer so we dont poll accelerometer for another 500ms
|
||||
}
|
||||
OLed_Display(); //Draw in the Oled display for this mode
|
||||
Status_Tran(); //Handle user input and mode changing
|
||||
ProcessUI();
|
||||
DrawUI();
|
||||
delayMs(50);
|
||||
}
|
||||
}
|
||||
/******************************** END OF FILE *********************************/
|
||||
void setup()
|
||||
{
|
||||
RCC_Config(); //setup system clock
|
||||
NVIC_Config(0x4000); //this shifts the NVIC table to be offset, for the usb bootloader's size
|
||||
GPIO_Config(); //setup all the GPIO pins
|
||||
Init_EXTI(); //init the EXTI inputs
|
||||
Init_Timer3(); //Used for the soldering iron tip
|
||||
Adc_Init(); //init adc and dma
|
||||
I2C_Configuration(); //Start the I2C hardware
|
||||
GPIO_Init_OLED(); //Init the GPIO ports for the OLED
|
||||
StartUp_Accelerometer(); //start the accelerometer
|
||||
Init_Oled(); //init the OLED display
|
||||
Clear_Screen(); //clear the display buffer to black
|
||||
setupPID(); //init the PID values
|
||||
readIronTemp(239, 0); //load the default calibration value
|
||||
restoreSettings(); //Load settings
|
||||
|
||||
Start_Watchdog(1000); //start the system watchdog as 1 seconds timeout
|
||||
}
|
||||
|
||||
282
workspace/ts100/src/Modes.c
Normal file
282
workspace/ts100/src/Modes.c
Normal file
@@ -0,0 +1,282 @@
|
||||
/*
|
||||
* Modes.c
|
||||
*
|
||||
* Created on: 17 Sep 2016
|
||||
* Author: Ralim <ralim@ralimtek.com>
|
||||
*/
|
||||
#include "Modes.h"
|
||||
//This does the required processing and state changes
|
||||
void ProcessUI() {
|
||||
uint8_t Buttons = getButtons(); //read the buttons status
|
||||
static uint32_t lastModeChange = 0;
|
||||
if (millis() - getLastButtonPress() < 200)
|
||||
Buttons = 0;
|
||||
//rough prevention for de-bouncing and allocates settling time
|
||||
|
||||
switch (operatingMode) {
|
||||
case STARTUP:
|
||||
if ((millis() - getLastButtonPress() > 1000)) {
|
||||
if (Buttons & BUT_A) {
|
||||
//A key pressed so we are moving to soldering mode
|
||||
operatingMode = SOLDERING;
|
||||
resetLastButtonPress();
|
||||
resetButtons();
|
||||
} else if (Buttons & BUT_B) {
|
||||
//B Button was pressed so we are moving to the Settings menu
|
||||
operatingMode = SETTINGS;
|
||||
resetLastButtonPress();
|
||||
resetButtons();
|
||||
}
|
||||
}
|
||||
//Nothing else to check here
|
||||
break;
|
||||
case SOLDERING:
|
||||
//We need to check the buttons if we need to jump out
|
||||
if (Buttons & BUT_A) {
|
||||
//A key pressed so we are moving to temp set
|
||||
operatingMode = TEMP_ADJ;
|
||||
resetLastButtonPress();
|
||||
resetButtons();
|
||||
} else if (Buttons & BUT_B) {
|
||||
//B Button was pressed so we are moving back to idle
|
||||
operatingMode = COOLING;
|
||||
resetLastButtonPress();
|
||||
resetButtons();
|
||||
} else {
|
||||
//We need to check the timer for movement in case we need to goto idle
|
||||
if (systemSettings.movementEnabled)
|
||||
if (millis() - getLastMovement()
|
||||
> (systemSettings.SleepTime * 60000)) {
|
||||
if (millis() - getLastButtonPress()
|
||||
> (systemSettings.SleepTime * 60000)) {
|
||||
operatingMode = SLEEP;
|
||||
return;
|
||||
}
|
||||
}
|
||||
uint16_t voltage = readDCVoltage(); //get X10 voltage
|
||||
if ((voltage / 10) < systemSettings.cutoutVoltage) {
|
||||
operatingMode = UVLOWARN;
|
||||
resetLastButtonPress();
|
||||
resetButtons();
|
||||
lastModeChange = millis();
|
||||
}
|
||||
//If no buttons pushed we need to perform the PID loop for the iron temp
|
||||
int32_t newOutput = computePID(systemSettings.SolderingTemp);
|
||||
|
||||
setIronTimer(newOutput);
|
||||
|
||||
}
|
||||
break;
|
||||
case TEMP_ADJ:
|
||||
if (Buttons & BUT_A) {
|
||||
//A key pressed so we are moving down in temp
|
||||
resetLastButtonPress();
|
||||
if (systemSettings.SolderingTemp > 1000)
|
||||
systemSettings.SolderingTemp -= 100;
|
||||
} else if (Buttons & BUT_B) {
|
||||
//B key pressed so we are moving up in temp
|
||||
resetLastButtonPress();
|
||||
if (systemSettings.SolderingTemp < 4500)
|
||||
systemSettings.SolderingTemp += 100;
|
||||
} else {
|
||||
//we check the timeout for how long the buttons have not been pushed
|
||||
//if idle for > 3 seconds then we return to soldering
|
||||
if (millis() - getLastButtonPress() > 3000)
|
||||
operatingMode = SOLDERING;
|
||||
}
|
||||
break;
|
||||
case SETTINGS:
|
||||
//Settings is the mode with the most logic
|
||||
//Here we are in the menu so we need to increment through the sub menus / increase the value
|
||||
if (millis() - getLastButtonPress() < 400)
|
||||
return;
|
||||
|
||||
if (Buttons & BUT_A) {
|
||||
resetLastButtonPress();
|
||||
//A key iterates through the menu
|
||||
if (settingsPage == 3) {
|
||||
//Roll off the end
|
||||
settingsPage = 0; //reset
|
||||
operatingMode = STARTUP;
|
||||
saveSettings(); //Save the settings
|
||||
} else
|
||||
++settingsPage; //move to the next option
|
||||
} else if (Buttons & BUT_B) {
|
||||
resetLastButtonPress();
|
||||
//B changes the value selected
|
||||
switch (settingsPage) {
|
||||
case UVLO:
|
||||
//we are incrementing the cutout voltage
|
||||
systemSettings.cutoutVoltage += 1; //Go up 1V at a jump
|
||||
if (systemSettings.cutoutVoltage > 24)
|
||||
systemSettings.cutoutVoltage = 9;
|
||||
else if (systemSettings.cutoutVoltage < 9)
|
||||
systemSettings.cutoutVoltage = 9; //cant set UVLO below 9V
|
||||
break;
|
||||
case SLEEP_TEMP:
|
||||
systemSettings.SleepTemp += 100; //Go up 10c at a time
|
||||
if (systemSettings.SleepTemp > 3000)
|
||||
systemSettings.SleepTemp = 1000;//cant sleep higher than 300
|
||||
break;
|
||||
case SLEEP_TIME:
|
||||
++systemSettings.SleepTime; //Go up 1 minute at a time
|
||||
if (systemSettings.SleepTime > 60)
|
||||
systemSettings.SleepTime = 2; //cant set time over an hour
|
||||
//Remember that ^ is the time of no movement
|
||||
break;
|
||||
case MOTIONDETECT:
|
||||
systemSettings.movementEnabled =
|
||||
!systemSettings.movementEnabled;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
break;
|
||||
case SLEEP:
|
||||
//The iron is sleeping at a lower temperature due to lack of movement
|
||||
if (Buttons & BUT_A) {
|
||||
//A Button was pressed so we are moving back to soldering
|
||||
operatingMode = SOLDERING;
|
||||
resetLastButtonPress();
|
||||
resetButtons();
|
||||
return;
|
||||
} else if (Buttons & BUT_B) {
|
||||
//B Button was pressed so we are moving back to soldering
|
||||
operatingMode = SOLDERING;
|
||||
resetLastButtonPress();
|
||||
resetButtons();
|
||||
return;
|
||||
} else if (systemSettings.movementEnabled)
|
||||
if (millis() - getLastMovement() < 1000) {//moved in the last second
|
||||
operatingMode = SOLDERING; //Goto active mode again
|
||||
return;
|
||||
}
|
||||
//else if nothing has been pushed we need to compute the PID to keep the iron at the sleep temp
|
||||
int32_t newOutput = computePID(systemSettings.SleepTemp);
|
||||
|
||||
setIronTimer(newOutput);
|
||||
|
||||
break;
|
||||
case COOLING: {
|
||||
setIronTimer(0); //turn off heating
|
||||
//This mode warns the user the iron is still cooling down
|
||||
uint16_t temp = readIronTemp(0, 1); //take a new reading as the heater code is not taking new readings
|
||||
if (temp < 500) { //if the temp is < 50C then we can go back to IDLE
|
||||
operatingMode = STARTUP;
|
||||
resetLastButtonPress();
|
||||
resetButtons();
|
||||
} else { //we check if the user has pushed a button to ack
|
||||
if ((millis() - getLastButtonPress() > 200)
|
||||
&& (millis() - getLastButtonPress() < 2000)) {
|
||||
if (getButtons() && (BUT_A | BUT_B)) {
|
||||
//A button was pushed
|
||||
operatingMode = STARTUP;
|
||||
resetLastButtonPress();
|
||||
resetButtons();
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
break;
|
||||
case UVLOWARN:
|
||||
//We are here if the DC voltage went too low
|
||||
//We want to jump back to IDLE after a bit
|
||||
if (millis() - lastModeChange > 3000) { //its been 3 seconds
|
||||
operatingMode = STARTUP; //jump back to idle mode
|
||||
}
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
void DrawUI() {
|
||||
uint16_t temp = readIronTemp(0, 0) / 10;
|
||||
switch (operatingMode) {
|
||||
case STARTUP:
|
||||
//We are chilling in the idle mode
|
||||
//Check if movement in the last 5 minutes , if not sleep OLED
|
||||
if (millis() - getLastMovement() > (5 * 60 * 1000)
|
||||
&& (millis() - getLastButtonPress() > (5 * 60 * 1000))) {
|
||||
//OLED off
|
||||
Oled_DisplayOff();
|
||||
} else {
|
||||
Oled_DisplayOn();
|
||||
OLED_DrawString("IDLE ", 7); //write the word IDLE
|
||||
}
|
||||
break;
|
||||
case SOLDERING:
|
||||
//The user is soldering
|
||||
{
|
||||
if (getIronTimer() == 0) {
|
||||
OLED_DrawChar('C', 14 * 4);
|
||||
} else {
|
||||
if (getIronTimer() < 500) {
|
||||
OLED_DrawChar(' ', 14 * 4);
|
||||
} else { //we are heating
|
||||
OLED_DrawChar('H', 14 * 4);
|
||||
}
|
||||
}
|
||||
OLED_DrawThreeNumber(temp, 0);
|
||||
OLED_DrawChar(' ', 14 * 3);
|
||||
OLED_DrawChar(' ', 14 * 5);
|
||||
OLED_DrawChar(' ', 14 * 6);
|
||||
}
|
||||
break;
|
||||
case TEMP_ADJ:
|
||||
//We are prompting the user to change the temp so we draw the current setpoint temp
|
||||
//With the nifty arrows
|
||||
OLED_DrawChar('<', 0);
|
||||
OLED_DrawThreeNumber(systemSettings.SolderingTemp / 10, 14 * 1);
|
||||
OLED_DrawChar(' ', 14 * 4);
|
||||
OLED_DrawChar('>', 14 * 5);
|
||||
break;
|
||||
case SETTINGS:
|
||||
//We are prompting the user the setting name
|
||||
|
||||
switch (settingsPage) {
|
||||
case UVLO:
|
||||
OLED_DrawString("UVLO", 4);
|
||||
OLED_DrawTwoNumber(systemSettings.cutoutVoltage, 14 * 4);
|
||||
//OLED_DrawChar('V', 14 * 5);
|
||||
|
||||
break;
|
||||
case SLEEP_TEMP:
|
||||
OLED_DrawString("STMP", 4);
|
||||
OLED_DrawThreeNumber(systemSettings.SleepTemp / 10, 14 * 4);
|
||||
//OLED_DrawChar('V', 14 * 5);
|
||||
|
||||
break;
|
||||
case SLEEP_TIME:
|
||||
OLED_DrawString("STME ", 5);
|
||||
OLED_DrawTwoNumber(systemSettings.SleepTime, 14 * 5);
|
||||
break;
|
||||
case MOTIONDETECT:/*Toggle the mode*/
|
||||
if (systemSettings.movementEnabled)
|
||||
OLED_DrawString("MOTN T", 7);
|
||||
else
|
||||
OLED_DrawString("MOTN F", 7);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case SLEEP:
|
||||
//The iron is in sleep temp mode
|
||||
//Draw in temp and sleep
|
||||
OLED_DrawString("SLP", 3);
|
||||
OLED_DrawThreeNumber(temp, 14 * 3);
|
||||
break;
|
||||
case COOLING:
|
||||
//We are warning the user the tip is cooling
|
||||
OLED_DrawString("COL", 3);
|
||||
OLED_DrawThreeNumber(temp, 14 * 3);
|
||||
break;
|
||||
case UVLOWARN:
|
||||
OLED_DrawString("UND VL", 6);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
@@ -1,51 +1,25 @@
|
||||
/********************* (C) COPYRIGHT 2015 e-Design Co.,Ltd. **********************
|
||||
File Name : Oled.c
|
||||
Version : S100 APP Ver 2.11
|
||||
Description:
|
||||
Author : Celery
|
||||
Data: 2015/07/07
|
||||
History:
|
||||
2015/07/07 ͳһ<CDB3><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
|
||||
*******************************************************************************/
|
||||
/*
|
||||
*
|
||||
* OLED.c
|
||||
* Functions for working with the oled screen.
|
||||
* Writes to the screen using I2C
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include "APP_Version.h"
|
||||
|
||||
#include "Oled.h"
|
||||
#include "Bios.h"
|
||||
#include "I2C.h"
|
||||
#include "Hardware.h"
|
||||
#include "Disk.h"
|
||||
#include "UI.h"
|
||||
|
||||
#include "Font.h"
|
||||
/*Setup params for the OLED screen*/
|
||||
u8 OLED_Setup_Array[46] = { 0x80, 0xAE, 0x80, 0xD5, 0x80, 0x52, 0x80, 0xA8,
|
||||
0x80, 0x0f, 0x80, 0xC0, 0x80, 0xD3, 0x80, 0x00, 0x80, 0x40, 0x80, 0xA0,
|
||||
0x80, 0x8D, 0x80, 0x14, 0x80, 0xDA, 0x80, 0x02, 0x80, 0x81, 0x80, 0x33,
|
||||
0x80, 0xD9, 0x80, 0xF1, 0x80, 0xDB, 0x80, 0x30, 0x80, 0xA4, 0x80, 0XA6,
|
||||
0x80, 0xAF };
|
||||
|
||||
//Setup params depending on oled model
|
||||
#ifdef SSD1316
|
||||
u8 gOled_param[50] = {0x80,0xAE,0x80,0x00,0x80,0x10,0x80,0x40,0x80,0xB0,0x80,
|
||||
0x81,0x80,0xFF,0x80,0xA0,0x80,0xA6,0x80,0xA8,0x80,0x1F,
|
||||
0x80,0xC8,0x80,0xD3,0x80,0x00,0x80,0xD5,0x80,0x80,0x80,
|
||||
0xD9,0x80,0x22,0x80,0xDA,0x80,0x12,0x80,0xDB,0x80,0x40,
|
||||
0x80,0x8D,0x80,0x14,0x80,0xAF,
|
||||
};
|
||||
#else
|
||||
u8 gOled_param[46] = { 0x80, 0xAE, 0x80, 0xD5, 0x80, 0x52, 0x80, 0xA8, 0x80,
|
||||
0x0f, 0x80, 0xC0, 0x80, 0xD3, 0x80, 0x00, 0x80, 0x40, 0x80, 0xA0, 0x80,
|
||||
0x8D, 0x80, 0x14, 0x80, 0xDA, 0x80, 0x02, 0x80, 0x81, 0x80, 0x33, 0x80,
|
||||
0xD9, 0x80, 0xF1, 0x80, 0xDB, 0x80, 0x30, 0x80, 0xA4, 0x80, 0XA6, 0x80,
|
||||
0xAF };
|
||||
#endif
|
||||
/*******************************************************************************
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>: Sc_Pt
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:<3A><>Ļ<EFBFBD><C4BB><EFBFBD><EFBFBD><EFBFBD>ı<EFBFBD><C4B1><EFBFBD>Ļ<EFBFBD>Աȶ<D4B1>
|
||||
<20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>:Co<43><6F>Ļ<EFBFBD>ԱȶȲ<C8B6><C8B2><EFBFBD>
|
||||
<20><><EFBFBD>ز<EFBFBD><D8B2><EFBFBD>:NULL
|
||||
*******************************************************************************/
|
||||
void Sc_Pt(u8 Co) //<2F><>Ļ<EFBFBD><C4BB><EFBFBD><EFBFBD>
|
||||
{
|
||||
u8 pt[4] = { 0x80, 0x81, 0x80, Co };
|
||||
|
||||
I2C_PageWrite(pt, 4, DEVICEADDR_OLED);
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function: Oled_DisplayOn
|
||||
Description:Turn on the Oled display
|
||||
@@ -71,16 +45,16 @@ void Oled_DisplayOff(void) {
|
||||
Input: number of bytes to write, array to write
|
||||
Output:
|
||||
*******************************************************************************/
|
||||
u8* Data_Command(u8 wide, u8* ptr) {
|
||||
u8* Data_Command(u8 length, u8* data) {
|
||||
int i;
|
||||
u8 tx_data[128];
|
||||
//here are are inserting the data write command at the beginning
|
||||
tx_data[0] = 0x40;
|
||||
wide += 1;
|
||||
for (i = 1; i < wide; i++) //Loop through the array of data
|
||||
tx_data[i] = *ptr++;
|
||||
I2C_PageWrite(tx_data, wide, DEVICEADDR_OLED); //write out the buffer
|
||||
return ptr;
|
||||
length += 1;
|
||||
for (i = 1; i < length; i++) //Loop through the array of data
|
||||
tx_data[i] = *data++;
|
||||
I2C_PageWrite(tx_data, length, DEVICEADDR_OLED); //write out the buffer
|
||||
return data;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:Set_ShowPos
|
||||
@@ -89,10 +63,8 @@ u8* Data_Command(u8 wide, u8* ptr) {
|
||||
*******************************************************************************/
|
||||
void Set_ShowPos(u8 x, u8 y) {
|
||||
u8 pos_param[8] = { 0x80, 0xB0, 0x80, 0x21, 0x80, 0x20, 0x80, 0x7F };
|
||||
|
||||
pos_param[5] = x + 32;
|
||||
pos_param[1] += y;
|
||||
|
||||
I2C_PageWrite(pos_param, 8, DEVICEADDR_OLED);
|
||||
}
|
||||
|
||||
@@ -123,20 +95,6 @@ u8* Oled_DrawArea(u8 x0, u8 y0, u8 wide, u8 high, u8* ptr) {
|
||||
return ptr;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Function:Clean_Char
|
||||
Description:Overwries a square to off, used to overwrite a char
|
||||
Inputs:(k) input X position char starts at, (wide) how many pixels wide the char is
|
||||
*******************************************************************************/
|
||||
void Clean_Char(int k, u8 wide) {
|
||||
int i;
|
||||
u8 tx_data[128];
|
||||
|
||||
memset(&tx_data[0], 0, wide);
|
||||
for (i = 0; i < 2; i++) {
|
||||
Oled_DrawArea(k, i * 8, wide, 8, tx_data);
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Function:GPIO_Init_OLED
|
||||
Description:Init the outputs as needed for the OLED (in this case the RST line)
|
||||
@@ -157,17 +115,11 @@ void Init_Oled(void) {
|
||||
u8 param_len;
|
||||
|
||||
OLED_RST();
|
||||
Delay_Ms(2);
|
||||
OLED_ACT();
|
||||
Delay_Ms(2);
|
||||
|
||||
#ifdef SSD1316
|
||||
param_len = 50;
|
||||
#else
|
||||
delayMs(2);
|
||||
OLED_ACT(); //Toggling reset to reset the oled
|
||||
delayMs(2);
|
||||
param_len = 46;
|
||||
#endif
|
||||
|
||||
I2C_PageWrite((u8 *) gOled_param, param_len, DEVICEADDR_OLED);
|
||||
I2C_PageWrite((u8 *) OLED_Setup_Array, param_len, DEVICEADDR_OLED);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
@@ -176,20 +128,56 @@ void Init_Oled(void) {
|
||||
*******************************************************************************/
|
||||
void Clear_Screen(void) {
|
||||
u8 tx_data[128];
|
||||
u8 i, wd;
|
||||
|
||||
#ifdef SSD1316
|
||||
wd = 32;
|
||||
#else
|
||||
wd = 16;
|
||||
#endif
|
||||
|
||||
memset(&tx_data[0], 0, 128);
|
||||
for (i = 0; i < wd / 8; i++) {
|
||||
for (u8 i = 0; i < 2; i++) {
|
||||
Oled_DrawArea(0, i * 8, 128, 8, tx_data);
|
||||
}
|
||||
}
|
||||
|
||||
void OLED_DrawString(char* string, uint8_t length) {
|
||||
for (uint8_t i = 0; i < length; i++) {
|
||||
OLED_DrawChar(string[i], i * 14);
|
||||
}
|
||||
}
|
||||
void OLED_DrawChar(char c, uint8_t x) {
|
||||
if ((x) > (128 - 14))
|
||||
return; //Rudimentary clipping to not draw off screen
|
||||
u8* ptr;
|
||||
ptr = (u8*) FONT;
|
||||
if (c >= 'A' && c <= 'Z') {
|
||||
ptr += (c - 'A' + 10) * (14 * 2); //alpha is ofset 10 chars into the array
|
||||
} else if (c >= '0' && c <= '9')
|
||||
ptr += (c - '0') * (14 * 2);
|
||||
else if (c < 10)
|
||||
ptr += (c) * (14 * 2);
|
||||
else if (c == ' ') {
|
||||
//blank on space bar
|
||||
ptr += (36) * (14 * 2);
|
||||
} else if (c == '<') {
|
||||
ptr += (37) * (14 * 2);
|
||||
} else if (c == '>') {
|
||||
ptr += (38) * (14 * 2);
|
||||
}
|
||||
|
||||
/******************************** END OF FILE *********************************/
|
||||
Oled_DrawArea(x, 0, 14, 16, (u8*) ptr);
|
||||
}
|
||||
/*
|
||||
* Draw a 2 digit number to the display
|
||||
* */
|
||||
void OLED_DrawTwoNumber(uint8_t in, uint8_t x) {
|
||||
OLED_DrawChar((in / 10) % 10, x);
|
||||
OLED_DrawChar(in % 10, x + 14);
|
||||
}
|
||||
void OLED_DrawThreeNumber(uint16_t in, uint8_t x) {
|
||||
|
||||
OLED_DrawChar((in / 100) % 10, x);
|
||||
OLED_DrawChar((in / 10) % 10, x + 14);
|
||||
OLED_DrawChar(in % 10, x + 28);
|
||||
}
|
||||
void OLED_DrawFourNumber(uint16_t in, uint8_t x) {
|
||||
|
||||
OLED_DrawChar((in / 1000) % 10, x);
|
||||
OLED_DrawChar((in / 100) % 10, x + 14);
|
||||
OLED_DrawChar((in / 10) % 10, x + 28);
|
||||
OLED_DrawChar(in % 10, x + 42);
|
||||
}
|
||||
|
||||
41
workspace/ts100/src/PID.c
Normal file
41
workspace/ts100/src/PID.c
Normal file
@@ -0,0 +1,41 @@
|
||||
/*
|
||||
* PID.c
|
||||
*
|
||||
* Created on: 20 Sep 2016
|
||||
* Author: ralim
|
||||
*/
|
||||
|
||||
#include "PID.h"
|
||||
#define MAXPIDOUTPUT 50000
|
||||
//This function computes the new value for the ON time of the system
|
||||
//This is the return value from this function
|
||||
int32_t computePID(uint16_t setpoint) {
|
||||
int32_t ITerm = 0;
|
||||
static int16_t lastReading = 0;
|
||||
uint16_t currentReading = readIronTemp(0, 1); //get the current temp of the iron
|
||||
int16_t error = (int16_t) setpoint - (int16_t) currentReading; //calculate the error term
|
||||
ITerm += (pidSettings.ki * error);
|
||||
if (ITerm > MAXPIDOUTPUT)
|
||||
ITerm = MAXPIDOUTPUT;
|
||||
else if (ITerm < 0)
|
||||
ITerm = 0; //cap at 0 since we cant force the iron to cool itself :)
|
||||
|
||||
int16_t DInput = (currentReading - lastReading); //compute the input to the D term
|
||||
int32_t output = (pidSettings.kp * error) + (ITerm)
|
||||
- (pidSettings.kd * DInput);
|
||||
if (output > MAXPIDOUTPUT)
|
||||
output = MAXPIDOUTPUT;
|
||||
else if (output < 0)
|
||||
output = 0;
|
||||
|
||||
lastReading = currentReading; //storing values for next iteration of the loop
|
||||
return output;
|
||||
|
||||
}
|
||||
/*Sets up the pid values*/
|
||||
void setupPID(void) {
|
||||
pidSettings.kp = 22;
|
||||
pidSettings.ki = 7;
|
||||
pidSettings.kd = 2;
|
||||
|
||||
}
|
||||
52
workspace/ts100/src/Settings.c
Normal file
52
workspace/ts100/src/Settings.c
Normal file
@@ -0,0 +1,52 @@
|
||||
/*
|
||||
* Settings.c
|
||||
*
|
||||
* Created on: 29 Sep 2016
|
||||
* Author: Ralim
|
||||
*
|
||||
* This file holds the users settings and saves / restores them to the devices flash
|
||||
*/
|
||||
|
||||
#include "Settings.h"
|
||||
#define FLASH_ADDR (0x8000000|48896)
|
||||
void saveSettings() {
|
||||
//First we erase the flash
|
||||
FLASH_Unlock(); //unlock flash writing
|
||||
FLASH_ClearFlag(FLASH_FLAG_EOP | FLASH_FLAG_PGERR | FLASH_FLAG_WRPRTERR);
|
||||
while (FLASH_ErasePage(FLASH_ADDR) != FLASH_COMPLETE)
|
||||
; //wait for it
|
||||
//erased the chunk
|
||||
//now we program it
|
||||
uint16_t *data = (uint16_t*) &systemSettings;
|
||||
for (uint8_t i = 0; i < (sizeof(systemSettings) / 2); i++) {
|
||||
FLASH_ProgramHalfWord(FLASH_ADDR + (i * 2), data[i]);
|
||||
}
|
||||
}
|
||||
|
||||
void restoreSettings() {
|
||||
//We read the flash
|
||||
uint16_t *data = (uint16_t*) &systemSettings;
|
||||
for(uint8_t i=0;i<(sizeof(systemSettings)/2);i++)
|
||||
{
|
||||
data[i] = *(uint16_t *)(FLASH_ADDR + (i*2));
|
||||
}
|
||||
//if the version is correct were done
|
||||
//if not we reset and save
|
||||
if (systemSettings.version != SETTINGSVERSION) {
|
||||
//probably not setup
|
||||
resetSettings();
|
||||
saveSettings();
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void resetSettings() {
|
||||
|
||||
systemSettings.SleepTemp = 900;
|
||||
systemSettings.SleepTime = 1;
|
||||
systemSettings.SolderingTemp = 3200;
|
||||
systemSettings.movementEnabled = 1; //we use movement detection
|
||||
systemSettings.cutoutVoltage = 9;
|
||||
systemSettings.version=SETTINGSVERSION;
|
||||
}
|
||||
|
||||
File diff suppressed because it is too large
Load Diff
@@ -1,269 +0,0 @@
|
||||
/******************** (C) COPYRIGHT 2015 e-Design Co., Ltd. ********************
|
||||
File Name : USB_bot.c
|
||||
Version : STM32_USB Disk Ver 3.4 Author : MCD Application Team & bure
|
||||
*******************************************************************************/
|
||||
#include "usb_scsi.h"
|
||||
#include "usb_regs.h"
|
||||
#include "usb_mem.h"
|
||||
#include "usb_conf.h"
|
||||
#include "usb_bot.h"
|
||||
#include "usb_prop.h"
|
||||
|
||||
u8 Bot_State;
|
||||
u8 Bulk_Buff[BULK_MAX_PACKET_SIZE]; // Data_ data buffer
|
||||
u16 Data_Len;
|
||||
Bulk_Only_CBW CBW;
|
||||
Bulk_Only_CSW CSW;
|
||||
u32 SCSI_LBA , SCSI_BlkLen;
|
||||
|
||||
/*******************************************************************************
|
||||
Mass_Storage_In: Mass Storage IN transfer.
|
||||
*******************************************************************************/
|
||||
void Mass_Storage_In (void)
|
||||
{
|
||||
switch (Bot_State)
|
||||
{
|
||||
case BOT_CSW_Send:
|
||||
case BOT_ERROR:
|
||||
Bot_State = BOT_IDLE;
|
||||
SetEPRxStatus(ENDP2, EP_RX_VALID);/* enable the Endpoint to receive the next cmd*/
|
||||
break;
|
||||
case BOT_DATA_IN:
|
||||
switch (CBW.CB[0])
|
||||
{
|
||||
case SCSI_READ10:
|
||||
SCSI_Read10_Cmd(SCSI_LBA , SCSI_BlkLen);
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case BOT_DATA_IN_LAST:
|
||||
Set_CSW (CSW_CMD_PASSED, SEND_CSW_ENABLE);
|
||||
SetEPRxStatus(ENDP2, EP_RX_VALID);
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Mass_Storage_Out: Mass Storage OUT transfer.
|
||||
*******************************************************************************/
|
||||
void Mass_Storage_Out (void)
|
||||
{
|
||||
u8 CMD;
|
||||
CMD = CBW.CB[0];
|
||||
Data_Len = GetEPRxCount(ENDP2);
|
||||
|
||||
PMAToUserBufferCopy(Bulk_Buff, ENDP2_RXADDR, Data_Len);
|
||||
|
||||
switch (Bot_State)
|
||||
{
|
||||
case BOT_IDLE:
|
||||
CBW_Decode();
|
||||
break;
|
||||
case BOT_DATA_OUT:
|
||||
if (CMD == SCSI_WRITE10)
|
||||
{
|
||||
SCSI_Write10_Cmd(SCSI_LBA , SCSI_BlkLen);
|
||||
break;
|
||||
}
|
||||
Bot_Abort(DIR_OUT);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_FIELED_IN_COMMAND);
|
||||
Set_CSW (CSW_PHASE_ERROR, SEND_CSW_DISABLE);
|
||||
break;
|
||||
default:
|
||||
Bot_Abort(BOTH_DIR);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_FIELED_IN_COMMAND);
|
||||
Set_CSW (CSW_PHASE_ERROR, SEND_CSW_DISABLE);
|
||||
break;
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
CBW_Decode: Decode the received CBW and call the related SCSI command
|
||||
*******************************************************************************/
|
||||
void CBW_Decode(void)
|
||||
{
|
||||
u32 Counter;
|
||||
|
||||
for (Counter = 0; Counter < Data_Len; Counter++)
|
||||
{
|
||||
*((u8 *)&CBW + Counter) = Bulk_Buff[Counter];
|
||||
}
|
||||
CSW.dTag = CBW.dTag;
|
||||
CSW.dDataResidue = CBW.dDataLength;
|
||||
if (Data_Len != BOT_CBW_PACKET_LENGTH)
|
||||
{
|
||||
Bot_Abort(BOTH_DIR);
|
||||
// reset the CBW.dSignature to desible the clear feature until receiving a Mass storage reset
|
||||
CBW.dSignature = 0;
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, PARAMETER_LIST_LENGTH_ERROR);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_DISABLE);
|
||||
return;
|
||||
}
|
||||
|
||||
if ((CBW.CB[0] == SCSI_READ10 ) || (CBW.CB[0] == SCSI_WRITE10 ))
|
||||
{
|
||||
// Calculate Logical Block Address
|
||||
SCSI_LBA = (CBW.CB[2] << 24) | (CBW.CB[3] << 16) | (CBW.CB[4] << 8) | CBW.CB[5];
|
||||
// Calculate the Number of Blocks to transfer
|
||||
SCSI_BlkLen = (CBW.CB[7] << 8) | CBW.CB[8];
|
||||
}
|
||||
|
||||
if (CBW.dSignature == BOT_CBW_SIGNATURE)
|
||||
{
|
||||
// Valid CBW
|
||||
if ((CBW.bLUN > Max_Lun) || (CBW.bCBLength < 1) || (CBW.bCBLength > 16))
|
||||
{
|
||||
Bot_Abort(BOTH_DIR);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_FIELED_IN_COMMAND);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_DISABLE);
|
||||
}
|
||||
else
|
||||
{
|
||||
switch (CBW.CB[0])
|
||||
{
|
||||
case SCSI_REQUEST_SENSE:
|
||||
SCSI_RequestSense_Cmd ();
|
||||
break;
|
||||
case SCSI_INQUIRY:
|
||||
SCSI_Inquiry_Cmd();
|
||||
break;
|
||||
case SCSI_START_STOP_UNIT:
|
||||
SCSI_Start_Stop_Unit_Cmd();
|
||||
break;
|
||||
case SCSI_ALLOW_MEDIUM_REMOVAL:
|
||||
SCSI_Start_Stop_Unit_Cmd();
|
||||
break;
|
||||
case SCSI_MODE_SENSE6:
|
||||
SCSI_ModeSense6_Cmd ();
|
||||
break;
|
||||
case SCSI_MODE_SENSE10:
|
||||
SCSI_ModeSense10_Cmd ();
|
||||
break;
|
||||
case SCSI_READ_FORMAT_CAPACITIES:
|
||||
SCSI_ReadFormatCapacity_Cmd();
|
||||
break;
|
||||
case SCSI_READ_CAPACITY10:
|
||||
SCSI_ReadCapacity10_Cmd();
|
||||
break;
|
||||
case SCSI_TEST_UNIT_READY:
|
||||
SCSI_TestUnitReady_Cmd();
|
||||
break;
|
||||
case SCSI_READ10:
|
||||
SCSI_Read10_Cmd(SCSI_LBA , SCSI_BlkLen);
|
||||
break;
|
||||
case SCSI_WRITE10:
|
||||
SCSI_Write10_Cmd(SCSI_LBA , SCSI_BlkLen);
|
||||
break;
|
||||
case SCSI_VERIFY10:
|
||||
SCSI_Verify10_Cmd();
|
||||
break;
|
||||
//Unsupported command
|
||||
case SCSI_MODE_SELECT10:
|
||||
SCSI_Mode_Select10_Cmd();
|
||||
break;
|
||||
case SCSI_MODE_SELECT6:
|
||||
SCSI_Mode_Select6_Cmd();
|
||||
break;
|
||||
|
||||
case SCSI_SEND_DIAGNOSTIC:
|
||||
SCSI_Send_Diagnostic_Cmd();
|
||||
break;
|
||||
case SCSI_READ6:
|
||||
SCSI_Read6_Cmd();
|
||||
break;
|
||||
case SCSI_READ12:
|
||||
SCSI_Read12_Cmd();
|
||||
break;
|
||||
case SCSI_READ16:
|
||||
SCSI_Read16_Cmd();
|
||||
break;
|
||||
case SCSI_READ_CAPACITY16:
|
||||
SCSI_READ_CAPACITY16_Cmd();
|
||||
break;
|
||||
case SCSI_WRITE6:
|
||||
SCSI_Write6_Cmd();
|
||||
break;
|
||||
case SCSI_WRITE12:
|
||||
SCSI_Write12_Cmd();
|
||||
break;
|
||||
case SCSI_WRITE16:
|
||||
SCSI_Write16_Cmd();
|
||||
break;
|
||||
case SCSI_VERIFY12:
|
||||
SCSI_Verify12_Cmd();
|
||||
break;
|
||||
case SCSI_VERIFY16:
|
||||
SCSI_Verify16_Cmd();
|
||||
break;
|
||||
|
||||
default:
|
||||
{
|
||||
Bot_Abort(BOTH_DIR);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_COMMAND);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_DISABLE);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
// Invalid CBW
|
||||
Bot_Abort(BOTH_DIR);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_COMMAND);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_DISABLE);
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Transfer_Data_Request: Send the request response to the PC HOST.
|
||||
Input : u8* Data_Address : point to the data to transfer.
|
||||
u16 Data_Length : the nember of Bytes to transfer.
|
||||
*******************************************************************************/
|
||||
void Transfer_Data_Request(u8* Data_Pointer, u16 Data_Len)
|
||||
{
|
||||
UserToPMABufferCopy(Data_Pointer, ENDP1_TXADDR, Data_Len);
|
||||
SetEPTxCount(ENDP1, Data_Len);
|
||||
SetEPTxStatus(ENDP1, EP_TX_VALID);
|
||||
Bot_State = BOT_DATA_IN_LAST;
|
||||
CSW.dDataResidue -= Data_Len;
|
||||
CSW.bStatus = CSW_CMD_PASSED;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Set_CSW: Set the SCW with the needed fields.
|
||||
Input : u8 CSW_Status this filed can be CSW_CMD_PASSED,CSW_CMD_FAILED,
|
||||
or CSW_PHASE_ERROR.
|
||||
*******************************************************************************/
|
||||
void Set_CSW (u8 CSW_Status, u8 Send_Permission)
|
||||
{
|
||||
CSW.dSignature = BOT_CSW_SIGNATURE;
|
||||
CSW.bStatus = CSW_Status;
|
||||
UserToPMABufferCopy(((u8 *)& CSW), ENDP1_TXADDR, CSW_DATA_LENGTH);
|
||||
SetEPTxCount(ENDP1, CSW_DATA_LENGTH);
|
||||
Bot_State = BOT_ERROR;
|
||||
if (Send_Permission){
|
||||
Bot_State = BOT_CSW_Send;
|
||||
SetEPTxStatus(ENDP1, EP_TX_VALID);
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Bot_Abort: Stall the needed Endpoint according to the selected direction.
|
||||
Input : Endpoint direction IN, OUT or both directions
|
||||
*******************************************************************************/
|
||||
void Bot_Abort(u8 Direction)
|
||||
{
|
||||
switch (Direction){
|
||||
case DIR_IN :
|
||||
SetEPTxStatus(ENDP1, EP_TX_STALL);
|
||||
break;
|
||||
case DIR_OUT :
|
||||
SetEPRxStatus(ENDP2, EP_RX_STALL);
|
||||
break;
|
||||
case BOTH_DIR :
|
||||
SetEPTxStatus(ENDP1, EP_TX_STALL);
|
||||
SetEPRxStatus(ENDP2, EP_RX_STALL);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
/********************************* END OF FILE ******************************/
|
||||
@@ -1,109 +0,0 @@
|
||||
/******************** (C) COPYRIGHT 2015 e-Design Co., Ltd. ********************
|
||||
File Name : USB_desc.c
|
||||
Version : STM32_USB Disk Ver 3.4 Author : MCD Application Team & bure
|
||||
*******************************************************************************/
|
||||
#include "usb_desc.h"
|
||||
|
||||
const u8 MASS_DeviceDescriptor[MASS_SIZ_DEVICE_DESC] ={
|
||||
0x12, /* bLength */
|
||||
0x01, /* bDescriptorType */
|
||||
0x00, /* bcdUSB, version 2.00 */
|
||||
0x02,
|
||||
0x00, /* bDeviceClass : each interface define the device class */
|
||||
0x00, /* bDeviceSubClass */
|
||||
0x00, /* bDeviceProtocol */
|
||||
0x40, /* bMaxPacketSize0 0x40 = 64 */
|
||||
0x83, /* idVendor (0483) */
|
||||
0x04,
|
||||
0x20, /* idProduct */
|
||||
0x57,
|
||||
0x00, /* bcdDevice 2.00*/
|
||||
0x02,
|
||||
1, /* index of string Manufacturer */
|
||||
/**/
|
||||
2, /* index of string descriptor of product*/
|
||||
/* */
|
||||
3, /* */
|
||||
/* */
|
||||
/* */
|
||||
0x01 /*bNumConfigurations */
|
||||
};
|
||||
const u8 MASS_ConfigDescriptor[MASS_SIZ_CONFIG_DESC] ={
|
||||
0x09, /* bLength: Configuation Descriptor size */
|
||||
0x02, /* bDescriptorType: Configuration */
|
||||
MASS_SIZ_CONFIG_DESC,
|
||||
0x00,
|
||||
0x01, /* bNumInterfaces: 1 interface */
|
||||
0x01, /* bConfigurationValue: */
|
||||
/* Configuration value */
|
||||
0x00, /* iConfiguration: */
|
||||
/* Index of string descriptor */
|
||||
/* describing the configuration */
|
||||
0xC0, /* bmAttributes: */
|
||||
/* bus powered */
|
||||
0x32, /* MaxPower 100 mA */
|
||||
|
||||
/******************** Descriptor of Mass Storage interface ********************/
|
||||
/* 09 */
|
||||
0x09, /* bLength: Interface Descriptor size */
|
||||
0x04, /* bDescriptorType: */
|
||||
/* Interface descriptor type */
|
||||
0x00, /* bInterfaceNumber: Number of Interface */
|
||||
0x00, /* bAlternateSetting: Alternate setting */
|
||||
0x02, /* bNumEndpoints*/
|
||||
0x08, /* bInterfaceClass: MASS STORAGE Class */
|
||||
0x06, /* bInterfaceSubClass : SCSI transparent*/
|
||||
0x50, /* nInterfaceProtocol */
|
||||
4, /* iInterface: */
|
||||
/* 18 */
|
||||
0x07, /*Endpoint descriptor length = 7*/
|
||||
0x05, /*Endpoint descriptor type */
|
||||
0x81, /*Endpoint address (IN, address 1) */
|
||||
0x02, /*Bulk endpoint type */
|
||||
0x40, /*Maximum packet size (64 bytes) */
|
||||
0x00,
|
||||
0x00, /*Polling interval in milliseconds */
|
||||
/* 25 */
|
||||
0x07, /*Endpoint descriptor length = 7 */
|
||||
0x05, /*Endpoint descriptor type */
|
||||
0x02, /*Endpoint address (OUT, address 2) */
|
||||
0x02, /*Bulk endpoint type */
|
||||
0x40, /*Maximum packet size (64 bytes) */
|
||||
0x00,
|
||||
0x00 /*Polling interval in milliseconds*/
|
||||
/*32*/
|
||||
};
|
||||
const u8 MASS_StringLangID[MASS_SIZ_STRING_LANGID] ={
|
||||
MASS_SIZ_STRING_LANGID,
|
||||
0x03,
|
||||
0x09,
|
||||
0x04
|
||||
}; // LangID = 0x0409: U.S. English //
|
||||
const u8 MASS_StringVendor[MASS_SIZ_STRING_VENDOR] ={
|
||||
MASS_SIZ_STRING_VENDOR, // Size of manufaturer string //
|
||||
0x03, // bDescriptorType = String descriptor //
|
||||
// Manufacturer: "STMicroelectronics" //
|
||||
'S', 0, 'T', 0, 'M', 0, 'i', 0, 'c', 0, 'r', 0, 'o', 0, 'e', 0,
|
||||
'l', 0, 'e', 0, 'c', 0, 't', 0, 'r', 0, 'o', 0, 'n', 0, 'i', 0,
|
||||
'c', 0, 's', 0
|
||||
};
|
||||
const u8 MASS_StringProduct[MASS_SIZ_STRING_PRODUCT] ={
|
||||
MASS_SIZ_STRING_PRODUCT,
|
||||
0x03,
|
||||
// Product name: "STM32F10x:USB Mass Storage" //
|
||||
'S', 0, 'T', 0, 'M', 0, '3', 0, '2', 0, ' ', 0, 'M', 0, 'a', 0, 's', 0,
|
||||
's', 0, ' ', 0, 'S', 0, 't', 0, 'o', 0, 'r', 0, 'a', 0, 'g', 0, 'e', 0
|
||||
};
|
||||
u8 MASS_StringSerial[MASS_SIZ_STRING_SERIAL] ={
|
||||
MASS_SIZ_STRING_SERIAL,
|
||||
0x03,
|
||||
// Serial number//
|
||||
'S', 0, 'T', 0, 'M', 0, '3', 0, '2', 0, '1', 0, '0', 0
|
||||
};
|
||||
const u8 MASS_StringInterface[MASS_SIZ_STRING_INTERFACE] ={
|
||||
MASS_SIZ_STRING_INTERFACE,
|
||||
0x03,
|
||||
// Interface 0: "ST Mass" //
|
||||
'S', 0, 'T', 0, ' ', 0, 'M', 0, 'a', 0, 's', 0, 's', 0
|
||||
};
|
||||
/********************************* END OF FILE ******************************/
|
||||
@@ -1,138 +0,0 @@
|
||||
/******************** (C) COPYRIGHT 2015 e-Design Co., Ltd. ********************
|
||||
File Name : USB_istr.c
|
||||
Version : STM32 USB Disk Ver 3.4 Author : MCD Application Team & bure
|
||||
*******************************************************************************/
|
||||
#include "usb_type.h"
|
||||
#include "usb_regs.h"
|
||||
#include "usb_pwr.h"
|
||||
#include "usb_istr.h"
|
||||
#include "usb_init.h"
|
||||
#include "usb_int.h"
|
||||
#include "usb_bot.h"
|
||||
|
||||
volatile u16 wIstr; /* ISTR register last read value */
|
||||
volatile u8 bIntPackSOF = 0; /* SOFs received between 2 consecutive packets */
|
||||
|
||||
void (*pEpInt_IN[7])(void) ={
|
||||
EP1_IN_Callback,
|
||||
EP2_IN_Callback,
|
||||
EP3_IN_Callback,
|
||||
EP4_IN_Callback,
|
||||
EP5_IN_Callback,
|
||||
EP6_IN_Callback,
|
||||
EP7_IN_Callback,
|
||||
};
|
||||
void (*pEpInt_OUT[7])(void) ={
|
||||
EP1_OUT_Callback,
|
||||
EP2_OUT_Callback,
|
||||
EP3_OUT_Callback,
|
||||
EP4_OUT_Callback,
|
||||
EP5_OUT_Callback,
|
||||
EP6_OUT_Callback,
|
||||
EP7_OUT_Callback,
|
||||
};
|
||||
/*******************************************************************************
|
||||
USB_Istr: ISTR events interrupt service routine
|
||||
*******************************************************************************/
|
||||
void USB_Istr(void)
|
||||
{
|
||||
wIstr = _GetISTR();
|
||||
#if (IMR_MSK & ISTR_RESET)
|
||||
if (wIstr & ISTR_RESET & wInterrupt_Mask){
|
||||
// _SetISTR((u16)CLR_RESET);
|
||||
Device_Property.Reset();
|
||||
_SetISTR((u16)CLR_RESET);
|
||||
//#ifdef RESET_CALLBACK
|
||||
// RESET_Callback();
|
||||
//#endif
|
||||
}
|
||||
#endif
|
||||
//-----------------------------------------------------------------------------
|
||||
#if (IMR_MSK & ISTR_DOVR)
|
||||
if (wIstr & ISTR_DOVR & wInterrupt_Mask){
|
||||
_SetISTR((u16)CLR_DOVR);
|
||||
//#ifdef DOVR_CALLBACK
|
||||
// DOVR_Callback();
|
||||
//#endif
|
||||
}
|
||||
#endif
|
||||
//-----------------------------------------------------------------------------
|
||||
#if (IMR_MSK & ISTR_ERR)
|
||||
if (wIstr & ISTR_ERR & wInterrupt_Mask){
|
||||
_SetISTR((u16)CLR_ERR);
|
||||
//#ifdef ERR_CALLBACK
|
||||
// ERR_Callback();
|
||||
//#endif
|
||||
}
|
||||
#endif
|
||||
//-----------------------------------------------------------------------------
|
||||
#if (IMR_MSK & ISTR_WKUP)
|
||||
if (wIstr & ISTR_WKUP & wInterrupt_Mask){
|
||||
// _SetISTR((u16)CLR_WKUP);
|
||||
Resume(RESUME_EXTERNAL);
|
||||
_SetISTR((u16)CLR_WKUP);
|
||||
//#ifdef WKUP_CALLBACK
|
||||
// WKUP_Callback();
|
||||
//#endif
|
||||
}
|
||||
#endif
|
||||
//-----------------------------------------------------------------------------
|
||||
#if (IMR_MSK & ISTR_SUSP)
|
||||
if (wIstr & ISTR_SUSP & wInterrupt_Mask){ // check if SUSPEND is possible
|
||||
if (fSuspendEnabled) Suspend();
|
||||
else Resume(RESUME_LATER); // if not possible then resume after xx ms
|
||||
_SetISTR((u16)CLR_SUSP); // clear of the ISTR bit must be done after setting of CNTR_FSUSP
|
||||
//#ifdef SUSP_CALLBACK
|
||||
// SUSP_Callback();
|
||||
//#endif
|
||||
}
|
||||
#endif
|
||||
//-----------------------------------------------------------------------------
|
||||
#if (IMR_MSK & ISTR_SOF)
|
||||
if (wIstr & ISTR_SOF & wInterrupt_Mask){
|
||||
_SetISTR((u16)CLR_SOF);
|
||||
bIntPackSOF++;
|
||||
//#ifdef SOF_CALLBACK
|
||||
// SOF_Callback();
|
||||
//#endif
|
||||
}
|
||||
#endif
|
||||
//-----------------------------------------------------------------------------
|
||||
#if (IMR_MSK & ISTR_ESOF)
|
||||
if (wIstr & ISTR_ESOF & wInterrupt_Mask){
|
||||
// _SetISTR((u16)CLR_ESOF); // resume handling timing is made with ESOFs
|
||||
Resume(RESUME_ESOF); // request without change of the machine state
|
||||
_SetISTR((u16)CLR_ESOF); // resume handling timing is made with ESOFs
|
||||
//#ifdef ESOF_CALLBACK
|
||||
// ESOF_Callback();
|
||||
//#endif
|
||||
}
|
||||
#endif
|
||||
//-----------------------------------------------------------------------------
|
||||
#if (IMR_MSK & ISTR_CTR)
|
||||
if (wIstr & ISTR_CTR & wInterrupt_Mask){
|
||||
/* servicing of the endpoint correct transfer interrupt */
|
||||
/* clear of the CTR flag into the sub */
|
||||
CTR_LP();
|
||||
//#ifdef CTR_CALLBACK
|
||||
// CTR_Callback();
|
||||
//#endif
|
||||
}
|
||||
#endif
|
||||
} /* USB_Istr */
|
||||
/*******************************************************************************
|
||||
EP1_IN_Callback: EP1 IN Callback Routine
|
||||
*******************************************************************************/
|
||||
void EP1_IN_Callback(void)
|
||||
{
|
||||
Mass_Storage_In();
|
||||
}
|
||||
/*******************************************************************************
|
||||
EP2_OUT_Callback: EP2 OUT Callback Routine.
|
||||
*******************************************************************************/
|
||||
void EP2_OUT_Callback(void)
|
||||
{
|
||||
Mass_Storage_Out();
|
||||
}
|
||||
/********************************* END OF FILE ******************************/
|
||||
|
||||
@@ -1,262 +0,0 @@
|
||||
/******************** (C) COPYRIGHT 2015 e-Design Co., Ltd. ********************
|
||||
File Name : USB_prop.c
|
||||
Version : STM32 USB Disk Ver 3.4 Author : MCD Application Team & bure
|
||||
*******************************************************************************/
|
||||
#include "usb_desc.h"
|
||||
#include "usb_pwr.h"
|
||||
#include "usb_bot.h"
|
||||
#include "usb_prop.h"
|
||||
#include "usb_lib.h"
|
||||
#include "Bios.h"
|
||||
#include "APP_Version.h"
|
||||
|
||||
u32 Max_Lun = 0;
|
||||
|
||||
DEVICE Device_Table ={ EP_NUM, 1 };
|
||||
DEVICE_PROP Device_Property ={
|
||||
MASS_init,
|
||||
MASS_Reset,
|
||||
MASS_Status_In,
|
||||
MASS_Status_Out,
|
||||
MASS_Data_Setup,
|
||||
MASS_NoData_Setup,
|
||||
MASS_Get_Interface_Setting,
|
||||
MASS_GetDeviceDescriptor,
|
||||
MASS_GetConfigDescriptor,
|
||||
MASS_GetStringDescriptor,
|
||||
0,
|
||||
0x40 // MAX PACKET SIZE
|
||||
};
|
||||
USER_STANDARD_REQUESTS User_Standard_Requests ={
|
||||
Mass_Storage_GetConfiguration,
|
||||
Mass_Storage_SetConfiguration,
|
||||
Mass_Storage_GetInterface,
|
||||
Mass_Storage_SetInterface,
|
||||
Mass_Storage_GetStatus,
|
||||
Mass_Storage_ClearFeature,
|
||||
Mass_Storage_SetEndPointFeature,
|
||||
Mass_Storage_SetDeviceFeature,
|
||||
Mass_Storage_SetDeviceAddress
|
||||
};
|
||||
ONE_DESCRIPTOR Device_Descriptor ={
|
||||
(u8*)MASS_DeviceDescriptor,
|
||||
MASS_SIZ_DEVICE_DESC
|
||||
};
|
||||
ONE_DESCRIPTOR Config_Descriptor ={
|
||||
(u8*)MASS_ConfigDescriptor,
|
||||
MASS_SIZ_CONFIG_DESC
|
||||
};
|
||||
ONE_DESCRIPTOR String_Descriptor[5] ={
|
||||
{(u8*)MASS_StringLangID, MASS_SIZ_STRING_LANGID},
|
||||
{(u8*)MASS_StringVendor, MASS_SIZ_STRING_VENDOR},
|
||||
{(u8*)MASS_StringProduct, MASS_SIZ_STRING_PRODUCT},
|
||||
{(u8*)MASS_StringSerial, MASS_SIZ_STRING_SERIAL},
|
||||
{(u8*)MASS_StringInterface, MASS_SIZ_STRING_INTERFACE},
|
||||
};
|
||||
|
||||
/*******************************************************************************
|
||||
MASS_init: Mass Storage init routine.
|
||||
*******************************************************************************/
|
||||
void MASS_init()
|
||||
{
|
||||
Get_SerialNum(); // Update the serial number string descriptor with the data from the unique ID
|
||||
pInformation->Current_Configuration = 0;
|
||||
PowerOn(); // Connect the device
|
||||
_SetISTR(0); // USB interrupts initialization. clear pending interrupts
|
||||
wInterrupt_Mask = IMR_MSK;
|
||||
_SetCNTR(wInterrupt_Mask); // set interrupts mask
|
||||
bDeviceState = UNCONNECTED;
|
||||
}
|
||||
/*******************************************************************************
|
||||
MASS_Reset: Mass Storage reset routine.
|
||||
*******************************************************************************/
|
||||
void MASS_Reset()
|
||||
{
|
||||
Device_Info.Current_Configuration = 0; // Set the device as not configured
|
||||
pInformation->Current_Feature = MASS_ConfigDescriptor[7]; // Current Feature initialization
|
||||
SetBTABLE(BTABLE_ADDRESS);
|
||||
// Initialize Endpoint 0
|
||||
SetEPType(ENDP0, EP_CONTROL);
|
||||
SetEPTxStatus(ENDP0, EP_TX_NAK);
|
||||
SetEPRxAddr(ENDP0, ENDP0_RXADDR);
|
||||
SetEPRxCount(ENDP0, Device_Property.MaxPacketSize);
|
||||
SetEPTxAddr(ENDP0, ENDP0_TXADDR);
|
||||
Clear_Status_Out(ENDP0);
|
||||
SetEPRxValid(ENDP0);
|
||||
//Initialize Endpoint 1
|
||||
SetEPType(ENDP1, EP_BULK);
|
||||
SetEPTxAddr(ENDP1, ENDP1_TXADDR);
|
||||
SetEPTxStatus(ENDP1, EP_TX_NAK);
|
||||
SetEPRxStatus(ENDP1, EP_RX_DIS);
|
||||
// Initialize Endpoint 2
|
||||
SetEPType(ENDP2, EP_BULK);
|
||||
SetEPRxAddr(ENDP2, ENDP2_RXADDR);
|
||||
SetEPRxCount(ENDP2, Device_Property.MaxPacketSize);
|
||||
SetEPRxStatus(ENDP2, EP_RX_VALID);
|
||||
SetEPTxStatus(ENDP2, EP_TX_DIS);
|
||||
|
||||
SetEPRxCount(ENDP0, Device_Property.MaxPacketSize);
|
||||
SetEPRxValid(ENDP0);
|
||||
// Set the device to response on default address
|
||||
SetDeviceAddress(0);
|
||||
|
||||
bDeviceState = ATTACHED;
|
||||
|
||||
CBW.dSignature = BOT_CBW_SIGNATURE;
|
||||
Bot_State = BOT_IDLE;
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Mass_Storage_SetConfiguration: Handle the SetConfiguration request.
|
||||
*******************************************************************************/
|
||||
void Mass_Storage_SetConfiguration(void)
|
||||
{
|
||||
if (pInformation->Current_Configuration != 0){
|
||||
bDeviceState = CONFIGURED; // Device configured
|
||||
ClearDTOG_TX(ENDP1);
|
||||
ClearDTOG_RX(ENDP2);
|
||||
Bot_State = BOT_IDLE; // set the Bot state machine to the IDLE state
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
Mass_Storage_ClearFeature: Handle the ClearFeature request.
|
||||
*******************************************************************************/
|
||||
void Mass_Storage_ClearFeature(void)
|
||||
{
|
||||
/* when the host send a CBW with invalid signature or invalid length the two
|
||||
Endpoints (IN & OUT) shall stall until receiving a Mass Storage Reset */
|
||||
if (CBW.dSignature != BOT_CBW_SIGNATURE)
|
||||
Bot_Abort(BOTH_DIR);
|
||||
}
|
||||
/*******************************************************************************
|
||||
Mass_Storage_SetConfiguration: Udpade the device state to addressed.
|
||||
*******************************************************************************/
|
||||
void Mass_Storage_SetDeviceAddress (void)
|
||||
{
|
||||
bDeviceState = ADDRESSED;
|
||||
}
|
||||
/*******************************************************************************
|
||||
MASS_Status_In: Mass Storage Status IN routine.
|
||||
*******************************************************************************/
|
||||
void MASS_Status_In(void)
|
||||
{
|
||||
return;
|
||||
}
|
||||
/*******************************************************************************
|
||||
MASS_Status_Out: Mass Storage Status OUT routine.
|
||||
*******************************************************************************/
|
||||
void MASS_Status_Out(void)
|
||||
{
|
||||
return;
|
||||
}
|
||||
/*******************************************************************************
|
||||
MASS_Data_Setup: Handle the data class specific requests.
|
||||
*******************************************************************************/
|
||||
RESULT MASS_Data_Setup(u8 RequestNo)
|
||||
{
|
||||
u8* (*CopyRoutine)(u16);
|
||||
|
||||
CopyRoutine = NULL;
|
||||
if ((Type_Recipient == (CLASS_REQUEST | INTERFACE_RECIPIENT))
|
||||
&& (RequestNo == GET_MAX_LUN) && (pInformation->USBwValue == 0)
|
||||
&& (pInformation->USBwIndex == 0) && (pInformation->USBwLength == 0x01))
|
||||
{
|
||||
CopyRoutine = Get_Max_Lun;
|
||||
} else return USB_UNSUPPORT;
|
||||
if (CopyRoutine == NULL) return USB_UNSUPPORT;
|
||||
pInformation->Ctrl_Info.CopyData = CopyRoutine;
|
||||
pInformation->Ctrl_Info.Usb_wOffset = 0;
|
||||
(*CopyRoutine)(0);
|
||||
return USB_SUCCESS;
|
||||
}
|
||||
/*******************************************************************************
|
||||
MASS_NoData_Setup: Handle the no data class specific requests.
|
||||
*******************************************************************************/
|
||||
RESULT MASS_NoData_Setup(u8 RequestNo)
|
||||
{
|
||||
if ((Type_Recipient == (CLASS_REQUEST | INTERFACE_RECIPIENT))
|
||||
&& (RequestNo == MASS_STORAGE_RESET) && (pInformation->USBwValue == 0)
|
||||
&& (pInformation->USBwIndex == 0) && (pInformation->USBwLength == 0x00))
|
||||
{
|
||||
ClearDTOG_TX(ENDP1); // Initialize Endpoint 1
|
||||
ClearDTOG_RX(ENDP2); // Initialize Endpoint 2
|
||||
CBW.dSignature = BOT_CBW_SIGNATURE; // intialise the CBW signature to enable the clear feature
|
||||
Bot_State = BOT_IDLE;
|
||||
return USB_SUCCESS;
|
||||
}
|
||||
return USB_UNSUPPORT;
|
||||
}
|
||||
/*******************************************************************************
|
||||
MASS_Get_Interface_Setting: Test the interface and the alternate setting
|
||||
according to the supported one.
|
||||
*******************************************************************************/
|
||||
RESULT MASS_Get_Interface_Setting(u8 Interface, u8 AlternateSetting)
|
||||
{
|
||||
if (AlternateSetting > 0) return USB_UNSUPPORT;// in this application we don't have AlternateSetting
|
||||
else if (Interface > 0) return USB_UNSUPPORT; // in this application we have only 1 interfaces
|
||||
return USB_SUCCESS;
|
||||
}
|
||||
/*******************************************************************************
|
||||
MASS_GetDeviceDescriptor: Get the device descriptor.
|
||||
*******************************************************************************/
|
||||
u8 *MASS_GetDeviceDescriptor(u16 Length)
|
||||
{
|
||||
return Standard_GetDescriptorData(Length, &Device_Descriptor );
|
||||
}
|
||||
/*******************************************************************************
|
||||
MASS_GetConfigDescriptor: Get the configuration descriptor.
|
||||
*******************************************************************************/
|
||||
u8 *MASS_GetConfigDescriptor(u16 Length)
|
||||
{
|
||||
return Standard_GetDescriptorData(Length, &Config_Descriptor );
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
MASS_GetStringDescriptor: Get the string descriptors according to
|
||||
the needed index.
|
||||
*******************************************************************************/
|
||||
u8 *MASS_GetStringDescriptor(u16 Length)
|
||||
{
|
||||
u8 wValue0 = pInformation->USBwValue0;
|
||||
if (wValue0 > 5) return NULL;
|
||||
else return Standard_GetDescriptorData(Length, &String_Descriptor[wValue0]);
|
||||
}
|
||||
/*******************************************************************************
|
||||
Get_Max_Lun: Handle the Get Max Lun request.
|
||||
*******************************************************************************/
|
||||
u8 *Get_Max_Lun(u16 Length)
|
||||
{
|
||||
if (Length == 0){
|
||||
pInformation->Ctrl_Info.Usb_wLength = LUN_DATA_LENGTH;
|
||||
return 0;
|
||||
} else return((u8*)(&Max_Lun));
|
||||
}
|
||||
/*******************************************************************************
|
||||
Get_SerialNum : Create the serial number string descriptor.
|
||||
*******************************************************************************/
|
||||
void Get_SerialNum(void)
|
||||
{
|
||||
u32 Device_Serial0, Device_Serial1, Device_Serial2;
|
||||
|
||||
Device_Serial0 = SERIAL_NO1;
|
||||
Device_Serial1 = SERIAL_NO2;
|
||||
Device_Serial2 = SERIAL_NO3;
|
||||
|
||||
if (Device_Serial0 != 0){
|
||||
MASS_StringSerial[ 2] = (u8)( Device_Serial0 & 0x000000FF);
|
||||
MASS_StringSerial[ 4] = (u8)((Device_Serial0 & 0x0000FF00) >> 8);
|
||||
MASS_StringSerial[ 6] = (u8)((Device_Serial0 & 0x00FF0000) >> 16);
|
||||
MASS_StringSerial[ 8] = (u8)((Device_Serial0 & 0xFF000000) >> 24);
|
||||
|
||||
MASS_StringSerial[10] = (u8)( Device_Serial1 & 0x000000FF);
|
||||
MASS_StringSerial[12] = (u8)((Device_Serial1 & 0x0000FF00) >> 8);
|
||||
MASS_StringSerial[14] = (u8)((Device_Serial1 & 0x00FF0000) >> 16);
|
||||
MASS_StringSerial[16] = (u8)((Device_Serial1 & 0xFF000000) >> 24);
|
||||
|
||||
MASS_StringSerial[18] = (u8)( Device_Serial2 & 0x000000FF);
|
||||
MASS_StringSerial[20] = (u8)((Device_Serial2 & 0x0000FF00) >> 8);
|
||||
MASS_StringSerial[22] = (u8)((Device_Serial2 & 0x00FF0000) >> 16);
|
||||
MASS_StringSerial[24] = (u8)((Device_Serial2 & 0xFF000000) >> 24);
|
||||
}
|
||||
}
|
||||
/********************************* END OF FILE ******************************/
|
||||
@@ -1,152 +0,0 @@
|
||||
/******************** (C) COPYRIGHT 2015 e-Design Co., Ltd. ********************
|
||||
File Name : USB_pwr.c
|
||||
Version : STM32 USB Disk Ver 3.4 Author : MCD Application Team & bure
|
||||
*******************************************************************************/
|
||||
#include "usb_lib.h"
|
||||
#include "usb_conf.h"
|
||||
#include "usb_pwr.h"
|
||||
|
||||
vu32 bDeviceState = UNCONNECTED; // USB device status
|
||||
vu8 fSuspendEnabled = TRUE; // true when suspend is possible
|
||||
|
||||
struct{
|
||||
volatile RESUME_STATE eState;
|
||||
volatile u8 bESOFcnt;
|
||||
} ResumeS;
|
||||
|
||||
/*******************************************************************************
|
||||
PowerOn Return : USB_SUCCESS
|
||||
|
||||
*******************************************************************************/
|
||||
RESULT PowerOn(void)
|
||||
{
|
||||
u16 wRegVal;
|
||||
|
||||
/*** CNTR_PWDN = 0 ***/
|
||||
wRegVal = CNTR_FRES;
|
||||
_SetCNTR(wRegVal);
|
||||
/*** CNTR_FRES = 0 ***/
|
||||
wInterrupt_Mask = 0;
|
||||
_SetCNTR(wInterrupt_Mask);
|
||||
/*** Clear pending interrupts ***/
|
||||
_SetISTR(0);
|
||||
/*** Set interrupt mask ***/
|
||||
wInterrupt_Mask = CNTR_RESETM | CNTR_SUSPM | CNTR_WKUPM;
|
||||
_SetCNTR(wInterrupt_Mask);
|
||||
|
||||
return USB_SUCCESS;
|
||||
}
|
||||
/*******************************************************************************
|
||||
PowerOff: handles switch-off conditions Return : USB_SUCCESS
|
||||
*******************************************************************************/
|
||||
RESULT PowerOff()
|
||||
{
|
||||
/* disable all ints and force USB reset */
|
||||
_SetCNTR(CNTR_FRES);
|
||||
/* clear interrupt status register */
|
||||
_SetISTR(0);
|
||||
/* Disable the Pull-Up*/
|
||||
// USB_Cable_Config(DISABLE);
|
||||
/* switch-off device */
|
||||
_SetCNTR(CNTR_FRES + CNTR_PDWN);
|
||||
/* sw variables reset */
|
||||
/* ... */
|
||||
|
||||
return USB_SUCCESS;
|
||||
}
|
||||
/*******************************************************************************
|
||||
Suspend: sets suspend mode operating conditions
|
||||
Return : USB_SUCCESS.
|
||||
*******************************************************************************/
|
||||
void Suspend(void)
|
||||
{
|
||||
u16 wCNTR;
|
||||
/* suspend preparation */
|
||||
/* macrocell enters suspend mode */
|
||||
wCNTR = _GetCNTR();
|
||||
wCNTR |= CNTR_FSUSP;
|
||||
_SetCNTR(wCNTR);
|
||||
/* ------------------ ONLY WITH BUS-POWERED DEVICES ---------------------- */
|
||||
/* power reduction */
|
||||
/* ... on connected devices */
|
||||
/* force low-power mode in the macrocell */
|
||||
wCNTR = _GetCNTR();
|
||||
wCNTR |= CNTR_LPMODE;
|
||||
_SetCNTR(wCNTR);
|
||||
}
|
||||
/*******************************************************************************
|
||||
Resume_Init: Handles wake-up restoring normal operations
|
||||
* Return : USB_SUCCESS.
|
||||
*******************************************************************************/
|
||||
void Resume_Init(void)
|
||||
{
|
||||
u16 wCNTR;
|
||||
/* ------------------ ONLY WITH BUS-POWERED DEVICES ---------------------- */
|
||||
/* restart the clocks */
|
||||
/* CNTR_LPMODE = 0 */
|
||||
wCNTR = _GetCNTR();
|
||||
wCNTR &= (~CNTR_LPMODE);
|
||||
_SetCNTR(wCNTR);
|
||||
/* restore full power */
|
||||
/* ... on connected devices */
|
||||
/* reset FSUSP bit */
|
||||
_SetCNTR(IMR_MSK);
|
||||
/* reverse suspend preparation */
|
||||
/* ... */
|
||||
}
|
||||
/*******************************************************************************
|
||||
Resume: This is the state machine handling resume operations and
|
||||
timing sequence. The control is based on the Resume structure
|
||||
variables and on the ESOF interrupt calling this subroutine
|
||||
without changing machine state.
|
||||
Input: a state machine value (RESUME_STATE)
|
||||
RESUME_ESOF doesn't change ResumeS.eState allowing
|
||||
decrementing of the ESOF counter in different states.
|
||||
*******************************************************************************/
|
||||
void Resume(RESUME_STATE eResumeSetVal)
|
||||
{
|
||||
u16 wCNTR;
|
||||
|
||||
if (eResumeSetVal != RESUME_ESOF) ResumeS.eState = eResumeSetVal;
|
||||
switch (ResumeS.eState){
|
||||
case RESUME_EXTERNAL:
|
||||
Resume_Init();
|
||||
ResumeS.eState = RESUME_OFF;
|
||||
break;
|
||||
case RESUME_INTERNAL:
|
||||
Resume_Init();
|
||||
ResumeS.eState = RESUME_START;
|
||||
break;
|
||||
case RESUME_LATER:
|
||||
ResumeS.bESOFcnt = 2;
|
||||
ResumeS.eState = RESUME_WAIT;
|
||||
break;
|
||||
case RESUME_WAIT:
|
||||
ResumeS.bESOFcnt--;
|
||||
if (ResumeS.bESOFcnt == 0)
|
||||
ResumeS.eState = RESUME_START;
|
||||
break;
|
||||
case RESUME_START:
|
||||
wCNTR = _GetCNTR();
|
||||
wCNTR |= CNTR_RESUME;
|
||||
_SetCNTR(wCNTR);
|
||||
ResumeS.eState = RESUME_ON;
|
||||
ResumeS.bESOFcnt = 10;
|
||||
break;
|
||||
case RESUME_ON:
|
||||
ResumeS.bESOFcnt--;
|
||||
if (ResumeS.bESOFcnt == 0){
|
||||
wCNTR = _GetCNTR();
|
||||
wCNTR &= (~CNTR_RESUME);
|
||||
_SetCNTR(wCNTR);
|
||||
ResumeS.eState = RESUME_OFF;
|
||||
}
|
||||
break;
|
||||
case RESUME_OFF:
|
||||
case RESUME_ESOF:
|
||||
default:
|
||||
ResumeS.eState = RESUME_OFF;
|
||||
break;
|
||||
}
|
||||
}
|
||||
/********************************* END OF FILE ******************************/
|
||||
@@ -1,230 +0,0 @@
|
||||
/******************** (C) COPYRIGHT 2015 e-Design Co., Ltd. ********************
|
||||
File Name : USB_scsi.c
|
||||
Version : STM32 USB Disk Ver 3.4 Author : MCD Application Team & bure
|
||||
*******************************************************************************/
|
||||
#include "usb_scsi.h"
|
||||
#include "usb_bot.h"
|
||||
#include "usb_regs.h"
|
||||
#include "usb_lib.h"
|
||||
#include "Disk.h"
|
||||
|
||||
u8 Page00_Inquiry_Data[] ={ 0, 0, 0, 0, 0};
|
||||
u8 Mode_Sense6_data[] ={0x03, 0x00, 0x00, 0x00};
|
||||
u8 Mode_Sense10_data[] ={0x00, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
|
||||
u8 Scsi_Sense_Data[] ={0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, 0x00,
|
||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
|
||||
u8 ReadCapacity10_Data[] ={ 0, 0, 0, 0, 0, 0, 0, 0};
|
||||
u8 ReadFormatCapacity[] ={ 0, 0, 0, 8, 0, 0, 0, 0, 2, 0, 0, 0};
|
||||
|
||||
#ifdef DFU_MODE
|
||||
uc8 Disk_Inquiry_Str[] ={0x00, 0x80, 0x02, 0x02, 36-4, 0x00, 0x00, 0x00,
|
||||
'V', 'i', 'r', 't', 'u', 'a', 'l', ' ',
|
||||
'D', 'F', 'U', ' ', 'D', 'i', 's', 'k',
|
||||
' ', ' ', ' ', ' ', ' ', ' ', ' ', ' ',
|
||||
' ', ' ', ' ', ' ', };
|
||||
#else
|
||||
uc8 Disk_Inquiry_Str[] ={0x00, 0x80, 0x02, 0x02, 36-4, 0x00, 0x00, 0x00,
|
||||
'M', 'i', 'n', 'i', ' ', 'D', 'S', 'O',
|
||||
'D', 'i', 's', 'k', ' ', ' ', ' ', ' ',
|
||||
' ', ' ', ' ', ' ', ' ', ' ', ' ', ' ',
|
||||
' ', ' ', ' ', ' ', };
|
||||
#endif
|
||||
|
||||
/*******************************************************************************
|
||||
SCSI_Inquiry_Cmd: SCSI Inquiry Command routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_Inquiry_Cmd(void)
|
||||
{
|
||||
u8* Inquiry_Data;
|
||||
u16 Inquiry_Data_Length;
|
||||
|
||||
if (CBW.CB[1] & 0x01){ // Evpd is set
|
||||
Inquiry_Data = Page00_Inquiry_Data;
|
||||
Inquiry_Data_Length = 5;
|
||||
} else {
|
||||
Inquiry_Data = (u8*)Disk_Inquiry_Str;
|
||||
if (CBW.CB[4] <= STANDARD_INQUIRY_DATA_LEN) Inquiry_Data_Length = CBW.CB[4];
|
||||
else Inquiry_Data_Length = STANDARD_INQUIRY_DATA_LEN;
|
||||
}
|
||||
Transfer_Data_Request(Inquiry_Data, Inquiry_Data_Length);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_ReadFormatCapacity_Cmd: SCSI ReadFormatCapacity Command routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_ReadFormatCapacity_Cmd(void)
|
||||
{
|
||||
ReadFormatCapacity[ 4] = (u8)(SECTOR_SIZE >> 24);
|
||||
ReadFormatCapacity[ 5] = (u8)(SECTOR_SIZE >> 16);
|
||||
ReadFormatCapacity[ 6] = (u8)(SECTOR_SIZE >> 8);
|
||||
ReadFormatCapacity[ 7] = (u8)(SECTOR_SIZE);
|
||||
|
||||
ReadFormatCapacity[ 9] = (u8)(SECTOR_SIZE >> 16);
|
||||
ReadFormatCapacity[10] = (u8)(SECTOR_SIZE >> 8);
|
||||
ReadFormatCapacity[11] = (u8)(SECTOR_SIZE);
|
||||
|
||||
Transfer_Data_Request(ReadFormatCapacity, READ_FORMAT_CAPACITY_DATA_LEN);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_ReadCapacity10_Cmd: SCSI ReadCapacity10 Command routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_ReadCapacity10_Cmd(void)
|
||||
{
|
||||
ReadCapacity10_Data[0] = (u8)(SECTOR_CNT - 1 >> 24);
|
||||
ReadCapacity10_Data[1] = (u8)(SECTOR_CNT - 1 >> 16);
|
||||
ReadCapacity10_Data[2] = (u8)(SECTOR_CNT - 1 >> 8);
|
||||
ReadCapacity10_Data[3] = (u8)(SECTOR_CNT - 1);
|
||||
|
||||
ReadCapacity10_Data[4] = (u8)(SECTOR_SIZE >> 24);
|
||||
ReadCapacity10_Data[5] = (u8)(SECTOR_SIZE >> 16);
|
||||
ReadCapacity10_Data[6] = (u8)(SECTOR_SIZE >> 8);
|
||||
ReadCapacity10_Data[7] = (u8)(SECTOR_SIZE);
|
||||
|
||||
Transfer_Data_Request(ReadCapacity10_Data, READ_CAPACITY10_DATA_LEN);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_ModeSense6_Cmd: SCSI ModeSense6 Command routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_ModeSense6_Cmd (void)
|
||||
{
|
||||
Transfer_Data_Request(Mode_Sense6_data, MODE_SENSE6_DATA_LEN);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_ModeSense10_Cmd: SCSI ModeSense10 Command routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_ModeSense10_Cmd (void)
|
||||
{
|
||||
Transfer_Data_Request(Mode_Sense10_data, MODE_SENSE10_DATA_LEN);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_RequestSense_Cmd: SCSI RequestSense Command routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_RequestSense_Cmd (void)
|
||||
{
|
||||
u8 Request_Sense_data_Length;
|
||||
|
||||
if (CBW.CB[4] <= REQUEST_SENSE_DATA_LEN) Request_Sense_data_Length = CBW.CB[4];
|
||||
else Request_Sense_data_Length = REQUEST_SENSE_DATA_LEN;
|
||||
|
||||
Transfer_Data_Request(Scsi_Sense_Data, Request_Sense_data_Length);
|
||||
}
|
||||
|
||||
/*******************************************************************************
|
||||
Set_Scsi_Sense_Data: Set Scsi Sense Data routine.
|
||||
*******************************************************************************/
|
||||
void Set_Scsi_Sense_Data(u8 Sens_Key, u8 Asc)
|
||||
{
|
||||
Scsi_Sense_Data[2] = Sens_Key;
|
||||
Scsi_Sense_Data[12] = Asc;
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_Start_Stop_Unit_Cmd: SCSI Start_Stop_Unit Command routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_Start_Stop_Unit_Cmd(void)
|
||||
{
|
||||
Set_CSW (CSW_CMD_PASSED, SEND_CSW_ENABLE);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_Read10_Cmd: SCSI Read10 Command routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_Read10_Cmd(u32 LBA , u32 BlockNbr)
|
||||
{
|
||||
if (Bot_State == BOT_IDLE){
|
||||
if (!(SCSI_Address_Management(SCSI_READ10, LBA, BlockNbr))) return;//address out of range
|
||||
if ((CBW.bmFlags & 0x80) != 0){
|
||||
Bot_State = BOT_DATA_IN;
|
||||
Read_Memory(LBA , BlockNbr);
|
||||
} else {
|
||||
Bot_Abort(BOTH_DIR);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_FIELED_IN_COMMAND);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_ENABLE);
|
||||
}
|
||||
return;
|
||||
} else if (Bot_State == BOT_DATA_IN) Read_Memory(LBA , BlockNbr);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_Write10_Cmd: SCSI Write10 Command routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_Write10_Cmd(u32 LBA , u32 BlockNbr)
|
||||
{
|
||||
if (Bot_State == BOT_IDLE){
|
||||
if (!(SCSI_Address_Management(SCSI_WRITE10 , LBA, BlockNbr))) return;//address out of range
|
||||
if ((CBW.bmFlags & 0x80) == 0){
|
||||
Bot_State = BOT_DATA_OUT;
|
||||
SetEPRxStatus(ENDP2, EP_RX_VALID);
|
||||
} else {
|
||||
Bot_Abort(DIR_IN);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_FIELED_IN_COMMAND);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_DISABLE);
|
||||
}
|
||||
return;
|
||||
} else if (Bot_State == BOT_DATA_OUT) Write_Memory(LBA , BlockNbr);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_Verify10_Cmd: SCSI Verify10 Command routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_Verify10_Cmd(void)
|
||||
{
|
||||
if ((CBW.dDataLength == 0) && !(CBW.CB[1] & BLKVFY)){ // BLKVFY not set
|
||||
Set_CSW (CSW_CMD_PASSED, SEND_CSW_ENABLE);
|
||||
} else {
|
||||
Bot_Abort(BOTH_DIR);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_FIELED_IN_COMMAND);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_DISABLE);
|
||||
}
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_Valid_Cmd: Valid Commands routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_Valid_Cmd(void)
|
||||
{
|
||||
if (CBW.dDataLength != 0){
|
||||
Bot_Abort(BOTH_DIR);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_COMMAND);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_DISABLE);
|
||||
} else Set_CSW (CSW_CMD_PASSED, SEND_CSW_ENABLE);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_Valid_Cmd: Valid Commands routine.
|
||||
*******************************************************************************/
|
||||
void SCSI_TestUnitReady_Cmd(void)
|
||||
{
|
||||
Set_CSW (CSW_CMD_PASSED, SEND_CSW_ENABLE);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_Invalid_Cmd: Invalid Commands routine
|
||||
*******************************************************************************/
|
||||
void SCSI_Invalid_Cmd(void)
|
||||
{
|
||||
if (CBW.dDataLength == 0) Bot_Abort(DIR_IN);
|
||||
else{
|
||||
if ((CBW.bmFlags & 0x80) != 0) Bot_Abort(DIR_IN);
|
||||
else Bot_Abort(BOTH_DIR);
|
||||
}
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_COMMAND);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_DISABLE);
|
||||
}
|
||||
/*******************************************************************************
|
||||
SCSI_Address_Management: Test the received address.
|
||||
Input: Cmd the command can be SCSI_READ10 or SCSI_WRITE10.
|
||||
Return: Read\Write status (bool).
|
||||
*******************************************************************************/
|
||||
u8 SCSI_Address_Management(u8 Cmd , u32 LBA , u32 BlockNbr)
|
||||
{
|
||||
|
||||
if ((LBA + BlockNbr) > SECTOR_CNT){
|
||||
if (Cmd == SCSI_WRITE10) Bot_Abort(BOTH_DIR);
|
||||
Bot_Abort(DIR_IN);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, ADDRESS_OUT_OF_RANGE);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_DISABLE);
|
||||
return (FALSE);
|
||||
}
|
||||
if (CBW.dDataLength != BlockNbr * SECTOR_SIZE){
|
||||
if (Cmd == SCSI_WRITE10) Bot_Abort(BOTH_DIR);
|
||||
else Bot_Abort(DIR_IN);
|
||||
Set_Scsi_Sense_Data(ILLEGAL_REQUEST, INVALID_FIELED_IN_COMMAND);
|
||||
Set_CSW (CSW_CMD_FAILED, SEND_CSW_DISABLE);
|
||||
return (FALSE);
|
||||
}
|
||||
return (TRUE);
|
||||
}
|
||||
/********************************* END OF FILE ******************************/
|
||||
Reference in New Issue
Block a user