Stefan Kögl
commit
c9fa341744
|
|
@ -0,0 +1,91 @@
|
||||||
|
#
|
||||||
|
# Makefile for msp430
|
||||||
|
#
|
||||||
|
# 'make' builds everything
|
||||||
|
# 'make clean' deletes everything except source files and Makefile
|
||||||
|
# You need to set TARGET, MCU and SOURCES for your project.
|
||||||
|
# TARGET is the name of the executable file to be produced
|
||||||
|
# $(TARGET).elf $(TARGET).hex and $(TARGET).txt nad $(TARGET).map are all generated.
|
||||||
|
# The TXT file is used for BSL loading, the ELF can be used for JTAG use
|
||||||
|
#
|
||||||
|
TARGET = mod-pulse-psychose
|
||||||
|
MCU = msp430fg439
|
||||||
|
|
||||||
|
# List all the source files here
|
||||||
|
# eg if you have a source file foo.c then list it here
|
||||||
|
SOURCES = mod_pulse.c
|
||||||
|
# Include are located in the Include directory
|
||||||
|
INCLUDES = -IInclude
|
||||||
|
|
||||||
|
# Add or subtract whatever MSPGCC flags you want. There are plenty more
|
||||||
|
#######################################################################################
|
||||||
|
CFLAGS = -mmcu=$(MCU) -g -Os -Wall -Wunused $(INCLUDES)
|
||||||
|
ASFLAGS = -mmcu=$(MCU) -x assembler-with-cpp -Wa,-gstabs
|
||||||
|
LDFLAGS = -mmcu=$(MCU) -Wl,-Map=$(TARGET).map -lm -lfp -pipe
|
||||||
|
########################################################################################
|
||||||
|
CC = msp430-gcc
|
||||||
|
LD = msp430-ld
|
||||||
|
AR = msp430-ar
|
||||||
|
AS = msp430-gcc
|
||||||
|
GASP = msp430-gasp
|
||||||
|
NM = msp430-nm
|
||||||
|
OBJCOPY = msp430-objcopy
|
||||||
|
RANLIB = msp430-ranlib
|
||||||
|
STRIP = msp430-strip
|
||||||
|
SIZE = msp430-size
|
||||||
|
READELF = msp430-readelf
|
||||||
|
MAKETXT = srec_cat
|
||||||
|
CP = cp -p
|
||||||
|
RM = rm -f
|
||||||
|
MV = mv
|
||||||
|
########################################################################################
|
||||||
|
# the file which will include dependencies
|
||||||
|
|
||||||
|
DEPEND = $(SOURCES:.c=.d)
|
||||||
|
|
||||||
|
# all the object files
|
||||||
|
OBJECTS = $(SOURCES:.c=.o)
|
||||||
|
|
||||||
|
#all: $(TARGET).elf $(TARGET).hex $(TARGET).txt
|
||||||
|
all: $(TARGET).elf $(TARGET).hex
|
||||||
|
$(TARGET).elf: $(OBJECTS)
|
||||||
|
echo "Linking $@"
|
||||||
|
$(CC) $(OBJECTS) $(LDFLAGS) $(LIBS) -o $@
|
||||||
|
echo
|
||||||
|
echo ">>>> Size of Firmware <<<<"
|
||||||
|
$(SIZE) $(TARGET).elf
|
||||||
|
echo
|
||||||
|
|
||||||
|
%.hex: %.elf
|
||||||
|
$(OBJCOPY) -O ihex $< $@
|
||||||
|
|
||||||
|
#%.txt: %.hex
|
||||||
|
# $(MAKETXT) -O $@ -TITXT $< -I
|
||||||
|
# unix2dos $(TARGET).txt
|
||||||
|
# The above line is required for the DOS based TI BSL tool to be able to read the txt file generated from linux/unix systems.
|
||||||
|
|
||||||
|
%.o: %.c
|
||||||
|
echo "Compiling $<"
|
||||||
|
$(CC) -c $(CFLAGS) -o $@ $<
|
||||||
|
|
||||||
|
# rule for making assembler source listing, to see the code
|
||||||
|
%.lst: %.c
|
||||||
|
$(CC) -c $(ASFLAGS) -Wa,-anlhd $< > $@
|
||||||
|
|
||||||
|
# include the dependencies unless we're going to clean, then forget about them.
|
||||||
|
ifneq ($(MAKECMDGOALS), clean)
|
||||||
|
-include $(DEPEND)
|
||||||
|
endif
|
||||||
|
# dependencies file
|
||||||
|
# includes also considered, since some of these are our own
|
||||||
|
# (otherwise use -MM instead of -M)
|
||||||
|
%.d: %.c
|
||||||
|
echo "Generating dependencies $@ from $<"
|
||||||
|
$(CC) -M ${CFLAGS} $< >$@
|
||||||
|
.SILENT:
|
||||||
|
.PHONY: clean
|
||||||
|
clean:
|
||||||
|
-$(RM) $(OBJECTS)
|
||||||
|
-$(RM) $(TARGET).*
|
||||||
|
-$(RM) $(SOURCES:.c=.lst)
|
||||||
|
-$(RM) $(DEPEND)
|
||||||
|
|
@ -0,0 +1,2 @@
|
||||||
|
msp430-gcc -I/usr/msp430/include -Wall mod_ -mmcu=msp430fg439 -o mod-pulse-pyschose -L /usr/msp430/lib/ldscripts/msp430fg439 -lm -lfp -pipe
|
||||||
|
|
||||||
|
|
@ -0,0 +1,917 @@
|
||||||
|
//*****************************************************************************
|
||||||
|
// THIS PROGRAM IS PROVIDED "AS IS". TI MAKES NO WARRANTIES OR
|
||||||
|
// REPRESENTATIONS, EITHER EXPRESS, IMPLIED OR STATUTORY,
|
||||||
|
// INCLUDING ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
|
||||||
|
// FOR A PARTICULAR PURPOSE, LACK OF VIRUSES, ACCURACY OR
|
||||||
|
// COMPLETENESS OF RESPONSES, RESULTS AND LACK OF NEGLIGENCE.
|
||||||
|
// TI DISCLAIMS ANY WARRANTY OF TITLE, QUIET ENJOYMENT, QUIET
|
||||||
|
// POSSESSION, AND NON-INFRINGEMENT OF ANY THIRD PARTY
|
||||||
|
// INTELLECTUAL PROPERTY RIGHTS WITH REGARD TO THE PROGRAM OR
|
||||||
|
// YOUR USE OF THE PROGRAM.
|
||||||
|
//
|
||||||
|
// IN NO EVENT SHALL TI BE LIABLE FOR ANY SPECIAL, INCIDENTAL,
|
||||||
|
// CONSEQUENTIAL OR INDIRECT DAMAGES, HOWEVER CAUSED, ON ANY
|
||||||
|
// THEORY OF LIABILITY AND WHETHER OR NOT TI HAS BEEN ADVISED
|
||||||
|
// OF THE POSSIBILITY OF SUCH DAMAGES, ARISING IN ANY WAY OUT
|
||||||
|
// OF THIS AGREEMENT, THE PROGRAM, OR YOUR USE OF THE PROGRAM.
|
||||||
|
// EXCLUDED DAMAGES INCLUDE, BUT ARE NOT LIMITED TO, COST OF
|
||||||
|
// REMOVAL OR REINSTALLATION, COMPUTER TIME, LABOR COSTS, LOSS
|
||||||
|
// OF GOODWILL, LOSS OF PROFITS, LOSS OF SAVINGS, OR LOSS OF
|
||||||
|
// USE OR INTERRUPTION OF BUSINESS. IN NO EVENT WILL TI'S
|
||||||
|
// AGGREGATE LIABILITY UNDER THIS AGREEMENT OR ARISING OUT OF
|
||||||
|
// YOUR USE OF THE PROGRAM EXCEED FIVE HUNDRED DOLLARS
|
||||||
|
// (U.S.$500).
|
||||||
|
//
|
||||||
|
// Unless otherwise stated, the Program written and copyrighted
|
||||||
|
// by Texas Instruments is distributed as "freeware". You may,
|
||||||
|
// only under TI's copyright in the Program, use and modify the
|
||||||
|
// Program without any charge or restriction. You may
|
||||||
|
// distribute to third parties, provided that you transfer a
|
||||||
|
// copy of this license to the third party and the third party
|
||||||
|
// agrees to these terms by its first use of the Program. You
|
||||||
|
// must reproduce the copyright notice and any other legend of
|
||||||
|
// ownership on each copy or partial copy, of the Program.
|
||||||
|
//
|
||||||
|
// You acknowledge and agree that the Program contains
|
||||||
|
// copyrighted material, trade secrets and other TI proprietary
|
||||||
|
// information and is protected by copyright laws,
|
||||||
|
// international copyright treaties, and trade secret laws, as
|
||||||
|
// well as other intellectual property laws. To protect TI's
|
||||||
|
// rights in the Program, you agree not to decompile, reverse
|
||||||
|
// engineer, disassemble or otherwise translate any object code
|
||||||
|
// versions of the Program to a human-readable form. You agree
|
||||||
|
// that in no event will you alter, remove or destroy any
|
||||||
|
// copyright notice included in the Program. TI reserves all
|
||||||
|
// rights not specifically granted under this license. Except
|
||||||
|
// as specifically provided herein, nothing in this agreement
|
||||||
|
// shall be construed as conferring by implication, estoppel,
|
||||||
|
// or otherwise, upon you, any license or other right under any
|
||||||
|
// TI patents, copyrights or trade secrets.
|
||||||
|
//
|
||||||
|
// You may not use the Program in non-TI devices.
|
||||||
|
//*****************************************************************************
|
||||||
|
// MSP430FG437 based pulse oximeter demonstration - Version II
|
||||||
|
// V. Chan and S. Underwood
|
||||||
|
// May 2005
|
||||||
|
// Modified by Bhargavi Nisarga
|
||||||
|
// April 2008
|
||||||
|
// All modifications related to Olimex's LCD were made by
|
||||||
|
// Penko T. Bozhkov, Olimex LTD
|
||||||
|
// June 2011
|
||||||
|
//*****************************************************************************
|
||||||
|
#include "msp430fg439.h"
|
||||||
|
#include "stdint.h"
|
||||||
|
#include "intrinsics.h"
|
||||||
|
#include "math.h"
|
||||||
|
|
||||||
|
// LCD Segment Configuration
|
||||||
|
#define seg_a 0x01
|
||||||
|
#define seg_b 0x02
|
||||||
|
#define seg_c 0x04
|
||||||
|
#define seg_d 0x08
|
||||||
|
#define seg_e 0x40
|
||||||
|
#define seg_f 0x10
|
||||||
|
#define seg_g 0x20
|
||||||
|
#define seg_h 0x80
|
||||||
|
|
||||||
|
#define NUM_0 (seg_a | seg_b | seg_c | seg_d | seg_e | seg_f)
|
||||||
|
#define NUM_1 (seg_b | seg_c)
|
||||||
|
#define NUM_2 (seg_a | seg_b | seg_d | seg_e | seg_g)
|
||||||
|
#define NUM_3 (seg_a | seg_b | seg_c | seg_d | seg_g)
|
||||||
|
#define NUM_4 (seg_b | seg_c | seg_f | seg_g)
|
||||||
|
#define NUM_5 (seg_a | seg_c | seg_d | seg_f | seg_g)
|
||||||
|
#define NUM_6 (seg_a | seg_c | seg_d | seg_e | seg_f | seg_g)
|
||||||
|
#define NUM_7 (seg_a | seg_b | seg_c)
|
||||||
|
#define NUM_8 (seg_a | seg_b | seg_c | seg_d | seg_e | seg_f | seg_g)
|
||||||
|
#define NUM_9 (seg_a | seg_b | seg_c | seg_d | seg_f | seg_g)
|
||||||
|
#define NUM_A (seg_a | seg_b | seg_c | seg_e | seg_f | seg_g)
|
||||||
|
#define NUM_B (seg_c | seg_d | seg_e | seg_f | seg_g)
|
||||||
|
#define NUM_C (seg_a | seg_d | seg_e | seg_f)
|
||||||
|
#define NUM_D (seg_b | seg_c | seg_d | seg_e | seg_g)
|
||||||
|
#define NUM_E (seg_a | seg_d | seg_e | seg_f | seg_g)
|
||||||
|
#define NUM_F (seg_a | seg_e | seg_f | seg_g)
|
||||||
|
|
||||||
|
|
||||||
|
// *****************************************************************
|
||||||
|
// Definitions related to Olimex's LCD Digits and initialization!!!!
|
||||||
|
// *****************************************************************
|
||||||
|
// Definitions for Olimex LCD digits 10 and 11
|
||||||
|
#define a 0x10
|
||||||
|
#define b 0x01
|
||||||
|
#define c 0x04
|
||||||
|
#define d 0x08
|
||||||
|
#define e 0x40
|
||||||
|
#define f 0x20
|
||||||
|
#define g 0x02
|
||||||
|
#define h 0x80
|
||||||
|
// Character generator definition for display digits 10 and 11
|
||||||
|
const char char_gen_10_11[] = {
|
||||||
|
a+b+c+d+e+f, // 0 Displays "0"
|
||||||
|
b+c, // 1 Displays "1"
|
||||||
|
a+b+d+e+g, // 2 Displays "2"
|
||||||
|
a+b+c+d+g, // 3 Displays "3"
|
||||||
|
b+c+f+g, // 4 Displays "4"
|
||||||
|
a+c+d+f+g, // 5 Displays "5"
|
||||||
|
a+c+d+e+f+g, // 6 Displays "6"
|
||||||
|
a+b+c, // 7 Displays "7"
|
||||||
|
a+b+c+d+e+f+g, // 8 Displays "8"
|
||||||
|
a+b+c+d+f+g, // 9 Displays "9"
|
||||||
|
};
|
||||||
|
// undefines
|
||||||
|
#undef a
|
||||||
|
#undef b
|
||||||
|
#undef c
|
||||||
|
#undef d
|
||||||
|
#undef e
|
||||||
|
#undef f
|
||||||
|
#undef g
|
||||||
|
#undef h
|
||||||
|
|
||||||
|
// Definitions for Olimex LCD digits 8 and 9
|
||||||
|
#define a 0x01
|
||||||
|
#define b 0x02
|
||||||
|
#define c 0x04
|
||||||
|
#define d 0x80
|
||||||
|
#define e 0x40
|
||||||
|
#define f 0x10
|
||||||
|
#define g 0x20
|
||||||
|
#define h 0x08
|
||||||
|
// Character generator definition for display digits 8 and 9
|
||||||
|
const char char_gen_8_9[] = {
|
||||||
|
a+b+c+d+e+f, // 0 Displays "0"
|
||||||
|
b+c, // 1 Displays "1"
|
||||||
|
a+b+d+e+g, // 2 Displays "2"
|
||||||
|
a+b+c+d+g, // 3 Displays "3"
|
||||||
|
b+c+f+g, // 4 Displays "4"
|
||||||
|
a+c+d+f+g, // 5 Displays "5"
|
||||||
|
a+c+d+e+f+g, // 6 Displays "6"
|
||||||
|
a+b+c, // 7 Displays "7"
|
||||||
|
a+b+c+d+e+f+g, // 8 Displays "8"
|
||||||
|
a+b+c+d+f+g, // 9 Displays "9"
|
||||||
|
};
|
||||||
|
// undefines
|
||||||
|
#undef a
|
||||||
|
#undef b
|
||||||
|
#undef c
|
||||||
|
#undef d
|
||||||
|
#undef e
|
||||||
|
#undef f
|
||||||
|
#undef g
|
||||||
|
#undef h
|
||||||
|
|
||||||
|
// Definitions for Olimex LCD digits 1 to 7. Here each digit definition require 2 bytes
|
||||||
|
#define a 0x0080
|
||||||
|
#define b 0x0040
|
||||||
|
#define c 0x0020
|
||||||
|
#define d 0x0010
|
||||||
|
#define e 0x2000
|
||||||
|
#define f 0x4000
|
||||||
|
#define g 0x0402
|
||||||
|
#define h 0x1000
|
||||||
|
// Character generator definition for display digits 1 to 7
|
||||||
|
const int char_gen_1_7[] = {
|
||||||
|
a+b+c+d+e+f, // 0 Displays "0"
|
||||||
|
b+c, // 1 Displays "1"
|
||||||
|
a+b+d+e+g, // 2 Displays "2"
|
||||||
|
a+b+c+d+g, // 3 Displays "3"
|
||||||
|
b+c+f+g, // 4 Displays "4"
|
||||||
|
a+c+d+f+g, // 5 Displays "5"
|
||||||
|
a+c+d+e+f+g, // 6 Displays "6"
|
||||||
|
a+b+c, // 7 Displays "7"
|
||||||
|
a+b+c+d+e+f+g, // 8 Displays "8"
|
||||||
|
a+b+c+d+f+g, // 9 Displays "9"
|
||||||
|
};
|
||||||
|
// undefines
|
||||||
|
#undef a
|
||||||
|
#undef b
|
||||||
|
#undef c
|
||||||
|
#undef d
|
||||||
|
#undef e
|
||||||
|
#undef f
|
||||||
|
#undef g
|
||||||
|
#undef h
|
||||||
|
|
||||||
|
|
||||||
|
int heart_pulse = 0;
|
||||||
|
|
||||||
|
int itobcd(int i) // Convert hex word to BCD.
|
||||||
|
{
|
||||||
|
int bcd = 0; //
|
||||||
|
char j = 0; //
|
||||||
|
|
||||||
|
while (i > 9) //
|
||||||
|
{
|
||||||
|
bcd |= ((i % 10) << j); //
|
||||||
|
i /= 10; //
|
||||||
|
j += 4;
|
||||||
|
} //
|
||||||
|
return (bcd | (i << j)); // Return converted value
|
||||||
|
}// itobcd(i)
|
||||||
|
|
||||||
|
|
||||||
|
const unsigned char hex_table[] =
|
||||||
|
{
|
||||||
|
NUM_0,NUM_1,NUM_2,NUM_3,NUM_4,NUM_5,NUM_6,NUM_7,
|
||||||
|
NUM_8,NUM_9,NUM_A,NUM_B,NUM_C,NUM_D,NUM_E,NUM_F
|
||||||
|
};
|
||||||
|
|
||||||
|
int32_t mul16(register int16_t x, register int16_t y) {
|
||||||
|
return ((long) x * y);
|
||||||
|
}
|
||||||
|
|
||||||
|
//FIR filter coefficient for removing 50/60Hz and 100/120Hz from the signals
|
||||||
|
#if 0
|
||||||
|
static const int16_t coeffs[9] =
|
||||||
|
{
|
||||||
|
5225,
|
||||||
|
5175,
|
||||||
|
7255,
|
||||||
|
9453,
|
||||||
|
11595,
|
||||||
|
13507,
|
||||||
|
15016,
|
||||||
|
15983,
|
||||||
|
16315
|
||||||
|
};
|
||||||
|
#else
|
||||||
|
static const int16_t coeffs[12] =
|
||||||
|
{
|
||||||
|
688,
|
||||||
|
1283,
|
||||||
|
2316,
|
||||||
|
3709,
|
||||||
|
5439,
|
||||||
|
7431,
|
||||||
|
9561,
|
||||||
|
11666,
|
||||||
|
13563,
|
||||||
|
15074,
|
||||||
|
16047,
|
||||||
|
16384
|
||||||
|
};
|
||||||
|
#endif
|
||||||
|
|
||||||
|
// SaO2 Look-up Table
|
||||||
|
const unsigned int Lookup [43] = {100,100,100,100,99,99,99,99,99,99,98,98,98,98,
|
||||||
|
98,97,97,97,97,97,97,96,96,96,96,96,96,95,95,
|
||||||
|
95,95,95,95,94,94,94,94,94,93,93,93,93,93};
|
||||||
|
//
|
||||||
|
// #define FIRST_STAGE_TARGET_HIGH 3900
|
||||||
|
// #define FIRST_STAGE_TARGET_LOW 3600
|
||||||
|
// #define FIRST_STAGE_TARGET_HIGH_FINE 4096
|
||||||
|
// #define FIRST_STAGE_TARGET_LOW_FINE 3500
|
||||||
|
|
||||||
|
// LED Target Range
|
||||||
|
#define FIRST_STAGE_TARGET_HIGH 3500
|
||||||
|
#define FIRST_STAGE_TARGET_LOW 3000
|
||||||
|
#define FIRST_STAGE_TARGET_HIGH_FINE 4096
|
||||||
|
#define FIRST_STAGE_TARGET_LOW_FINE 2700
|
||||||
|
#define FIRST_STAGE_STEP 5
|
||||||
|
#define FIRST_STAGE_FINE_STEP 1
|
||||||
|
|
||||||
|
// UART Transmission Structure Definition
|
||||||
|
enum scope_type_e
|
||||||
|
{
|
||||||
|
SCOPE_TYPE_OFF = 0,
|
||||||
|
SCOPE_TYPE_HEART_SIGNALS,
|
||||||
|
SCOPE_TYPE_RAW_SIGNALS,
|
||||||
|
SCOPE_TYPE_LED_DRIVE,
|
||||||
|
};
|
||||||
|
int scope_type = SCOPE_TYPE_HEART_SIGNALS;
|
||||||
|
//int scope_type = SCOPE_TYPE_RAW_SIGNALS;
|
||||||
|
|
||||||
|
int ir_dc_offset = 2000;
|
||||||
|
int vs_dc_offset = 2000;
|
||||||
|
int ir_LED_level;
|
||||||
|
int vs_LED_level;
|
||||||
|
int ir_sample;
|
||||||
|
int vs_sample;
|
||||||
|
char is_IR;
|
||||||
|
int ir_heart_signal;
|
||||||
|
int vs_heart_signal;
|
||||||
|
int ir_heart_ac_signal;
|
||||||
|
int vs_heart_ac_signal;
|
||||||
|
unsigned int rms_ir_heart_ac_signal;
|
||||||
|
unsigned int rms_vs_heart_ac_signal;
|
||||||
|
int32_t ir_2nd_dc_register = 0;
|
||||||
|
int32_t vs_2nd_dc_register = 0;
|
||||||
|
unsigned long log_sq_ir_heart_ac_signal;
|
||||||
|
unsigned long log_sq_vs_heart_ac_signal;
|
||||||
|
unsigned long sq_ir_heart_ac_signal;
|
||||||
|
unsigned long sq_vs_heart_ac_signal;
|
||||||
|
unsigned int pos_edge = 0;
|
||||||
|
unsigned int edge_debounce;
|
||||||
|
unsigned int heart_beat_counter;
|
||||||
|
unsigned int log_heart_signal_sample_counter;
|
||||||
|
unsigned int heart_signal_sample_counter;
|
||||||
|
|
||||||
|
volatile unsigned int j;
|
||||||
|
|
||||||
|
/* The results */
|
||||||
|
unsigned int heart_rate;
|
||||||
|
unsigned int heart_rate_LSB = 0;
|
||||||
|
unsigned int SaO2, Ratio;
|
||||||
|
unsigned int SaO2_LSB = 0;
|
||||||
|
|
||||||
|
/* Function prototypes */
|
||||||
|
//unsigned long isqrt32(register unsigned long h);
|
||||||
|
int16_t dc_estimator(register int32_t *p, register int16_t x);
|
||||||
|
int16_t ir_filter(int16_t sample);
|
||||||
|
int16_t vs_filter(int16_t sample);
|
||||||
|
void set_LCD(void);
|
||||||
|
void display_number(int value, int start, int width);
|
||||||
|
void display_pulse(int on);
|
||||||
|
void display_correcting(int x, int on);
|
||||||
|
|
||||||
|
void delay(long cycles){
|
||||||
|
while(cycles){ cycles--; }
|
||||||
|
}
|
||||||
|
|
||||||
|
int main(void)
|
||||||
|
{
|
||||||
|
double f1;
|
||||||
|
int32_t x;
|
||||||
|
int32_t y;
|
||||||
|
|
||||||
|
WDTCTL = WDTPW | WDTHOLD;
|
||||||
|
SCFI0 |= FN_4; // x2 DCO frequency, 8MHz nominal
|
||||||
|
// DCO
|
||||||
|
SCFQCTL = 91; // 32768 x 2 x (91 + 1) = 6.03 MHz
|
||||||
|
FLL_CTL0 = DCOPLUS + XCAP10PF; // DCO+ set so freq = xtal x D x
|
||||||
|
//(N + 1)
|
||||||
|
// Loop until 32kHz crystal stabilizes
|
||||||
|
do
|
||||||
|
{
|
||||||
|
IFG1 &= ~OFIFG; // Clear oscillator fault flag
|
||||||
|
for (j = 50000; j; j--); // Delay
|
||||||
|
}
|
||||||
|
while (IFG1 & OFIFG); // Test osc fault flag
|
||||||
|
|
||||||
|
// Setup GPIO
|
||||||
|
P1DIR = 0xFF;
|
||||||
|
P1OUT = 0;
|
||||||
|
P2DIR = 0xFF;
|
||||||
|
P2DIR |= BIT2 + BIT3; // P2.2 and P2.3 o/p direction -
|
||||||
|
// drives PNP transistors in H-Bridge
|
||||||
|
P2OUT = 0;
|
||||||
|
P3DIR = 0xFF;
|
||||||
|
P3OUT = 0;
|
||||||
|
P4DIR = 0xFF;
|
||||||
|
P4OUT = 0;
|
||||||
|
P5DIR = 0xFF;
|
||||||
|
P5OUT = 0;
|
||||||
|
P6OUT = 0;
|
||||||
|
|
||||||
|
/* Setup LCD */
|
||||||
|
set_LCD();
|
||||||
|
|
||||||
|
/* First amplifier stage - transconductance configuration */
|
||||||
|
P6SEL |= (BIT0 | BIT1 | BIT2); // Select OA0O
|
||||||
|
// -ve=OA0I0, +ve=OA0I1
|
||||||
|
OA0CTL0 = OAN_0 | OAP_1 | OAPM_3 | OAADC1;
|
||||||
|
OA0CTL1 = 0;
|
||||||
|
|
||||||
|
/* Second amplifier stage */
|
||||||
|
P6SEL |= (BIT3 | BIT4); // Select 0A1O 0A1I
|
||||||
|
// -ve=OA1I0, +ve=DAC1
|
||||||
|
// -ve=OA1I0, +ve=DAC1
|
||||||
|
// OA1CTL0 = OAN_0 | OAP_3 | OAPM_3 | OAADC1;
|
||||||
|
// OA1CTL1 = 0x00;
|
||||||
|
// Inverted input internally
|
||||||
|
// connected to OA0 output
|
||||||
|
OA1CTL0 = OAN_2 + OAP_3 + OAPM_3 + OAADC1;
|
||||||
|
OA1CTL1 = OAFBR_7 + OAFC_6; // OA as inv feedback amp, internal
|
||||||
|
// gain = 15;
|
||||||
|
|
||||||
|
/* Configure DAC 1 to provide bias for the amplifier */
|
||||||
|
P6SEL |= BIT7;
|
||||||
|
DAC12_1CTL = DAC12CALON | DAC12IR | DAC12AMP_7 | DAC12ENC;
|
||||||
|
DAC12_1DAT = 0;
|
||||||
|
|
||||||
|
/* Configure DAC 0 to provide variable drive to the LEDs */
|
||||||
|
DAC12_0CTL = DAC12CALON | DAC12IR | DAC12AMP_7 | DAC12ENC; // VRef+, high speed/current,
|
||||||
|
// DAC12OPS=0 => DAC12_0 output on P6.6 (pin 5) */
|
||||||
|
// Configure P2.2 and P2.3 to
|
||||||
|
// provide variable drive to LEDs
|
||||||
|
P2OUT |= BIT2; // turn off source for D2
|
||||||
|
P2OUT &= ~BIT3; // turn on source for D3
|
||||||
|
DAC12_0DAT = 3340;
|
||||||
|
|
||||||
|
// Set initial values for the LED brightnesses
|
||||||
|
ir_LED_level = 1300;
|
||||||
|
vs_LED_level = 1450;
|
||||||
|
|
||||||
|
/* Configure ADC12 */
|
||||||
|
ADC12CTL0 &= ~ENC; // Enable conversions
|
||||||
|
// Turn on the ADC12, and
|
||||||
|
// set the sampling time
|
||||||
|
ADC12CTL0 = ADC12ON + MSC + SHT0_4 + REFON + REF2_5V;
|
||||||
|
ADC12CTL1 = SHP + SHS_1 + CONSEQ_1; // Use sampling timer, single sequence,
|
||||||
|
// TA1 trigger(SHS_1), start with ADC12MEM0
|
||||||
|
ADC12MCTL0 = INCH_1 + SREF_1; // ref+=Vref, channel = A1 = OA0
|
||||||
|
ADC12MCTL1 = INCH_3 + SREF_1 + EOS; // ref+=Vref, channel = A3 = OA1
|
||||||
|
ADC12IE = BIT1; // ADC12MEM1 interrupt enable
|
||||||
|
ADC12CTL0 |= ENC; // Enable the ADC
|
||||||
|
ADC12CTL0 |= ADC12SC; // Start conversion
|
||||||
|
|
||||||
|
/* Configure Timer */
|
||||||
|
TACTL = TASSEL0 + TACLR; // ACLK, clear TAR,
|
||||||
|
TACCTL1 = OUTMOD_2;
|
||||||
|
TACCTL0 = CCIE;
|
||||||
|
// This gives a sampling rate of
|
||||||
|
// 512sps
|
||||||
|
TACCR0 = 31; // Do two channels, at
|
||||||
|
// 512sps each.
|
||||||
|
TACCR1 = 10; // Allow plenty of time for the
|
||||||
|
// signal to become stable before
|
||||||
|
// sampling
|
||||||
|
TACTL |= MC_1; // Timer A on, up mode
|
||||||
|
|
||||||
|
/*Configure USART, so we can report readings to a PC */
|
||||||
|
P2DIR |= BIT4;
|
||||||
|
P2SEL |= BIT4;
|
||||||
|
|
||||||
|
UCTL0 |= SWRST;
|
||||||
|
ME1 |= UTXE0; // Enable USART1 TXD
|
||||||
|
UCTL0 |= CHAR; // 8-bit char, SWRST=1
|
||||||
|
UTCTL0 |= SSEL1; // UCLK = SMCLK
|
||||||
|
UBR00 = 52; // 115200 from 6.02MHz = 52.33
|
||||||
|
UBR10 = 0x00;
|
||||||
|
UMCTL0 = 0x45; // Modulation = 0.375
|
||||||
|
UCTL0 &= ~SWRST; // Initialise USART
|
||||||
|
|
||||||
|
|
||||||
|
/*
|
||||||
|
// For Olimex's LCD debug purpose only!
|
||||||
|
int j=999;
|
||||||
|
for(int i=0;i<10;i++){
|
||||||
|
delay(700000);
|
||||||
|
display_number(j, 3, 3); // The Small digits
|
||||||
|
display_number(j, 7, 3); // The Large digits
|
||||||
|
j = j-111;
|
||||||
|
}
|
||||||
|
set_LCD();
|
||||||
|
*/
|
||||||
|
|
||||||
|
while(1)
|
||||||
|
{
|
||||||
|
__bis_SR_register(LPM0_bits + GIE);
|
||||||
|
__bis_SR_register(LPM0_bits); // Enter LPM0 needed for UART TX completion
|
||||||
|
__no_operation();
|
||||||
|
|
||||||
|
/* Heart Rate Computation */
|
||||||
|
f1 = 60.0*512.0*3.0/(float)log_heart_signal_sample_counter;
|
||||||
|
heart_rate = (unsigned int)f1;
|
||||||
|
//heart_rate = f1;
|
||||||
|
display_number(heart_rate, 3, 3);
|
||||||
|
heart_rate_LSB = heart_rate & 0x00FF;
|
||||||
|
|
||||||
|
/* SaO2 Computation */
|
||||||
|
x = log_sq_ir_heart_ac_signal/log_heart_signal_sample_counter;
|
||||||
|
y = log_sq_vs_heart_ac_signal/log_heart_signal_sample_counter;
|
||||||
|
Ratio = (unsigned int) (100.0*logf(y)/logf(x));
|
||||||
|
if (Ratio > 66)
|
||||||
|
SaO2 = Lookup[Ratio - 66]; // Ratio - 50 (Look-up Table Offset) - 16 (Ratio offset)
|
||||||
|
else if (Ratio > 50)
|
||||||
|
SaO2 = Lookup[Ratio - 50]; // Ratio - 50 (Look-up Table Offset)
|
||||||
|
else
|
||||||
|
//SaO2 = 100;
|
||||||
|
SaO2 = 99;
|
||||||
|
display_number(SaO2, 7, 3);
|
||||||
|
SaO2_LSB = SaO2 & 0x00FF;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
// Timer A0 interrupt service routine
|
||||||
|
#pragma vector=TIMERA0_VECTOR
|
||||||
|
__interrupt void Timer_A0(void)
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
if ((DAC12_0CTL & DAC12OPS)) // D2 enabled in demo board
|
||||||
|
{
|
||||||
|
// Immediately enable the visible
|
||||||
|
// LED, to allow time for the
|
||||||
|
// transimpedance amp to settle
|
||||||
|
DAC12_0CTL &= ~DAC12ENC;
|
||||||
|
P2OUT &= ~BIT3; // turn on source for D3
|
||||||
|
DAC12_0CTL &= ~DAC12OPS; // Disable IR LED, enable visible LED
|
||||||
|
DAC12_0CTL |= DAC12ENC;
|
||||||
|
DAC12_0DAT = vs_LED_level;
|
||||||
|
DAC12_1DAT = vs_dc_offset; // Load op-amp offset value for visible
|
||||||
|
P2OUT |= BIT2; // turn off source for D2
|
||||||
|
|
||||||
|
is_IR = 0; // IR LED OFF
|
||||||
|
|
||||||
|
ir_sample = ADC12MEM0; // Read the IR LED results
|
||||||
|
i = ADC12MEM1;
|
||||||
|
// Enable the next conversion sequence.
|
||||||
|
// The sequence is started by TA1
|
||||||
|
ADC12CTL0 &= ~ENC;
|
||||||
|
ADC12CTL0 |= ENC;
|
||||||
|
|
||||||
|
// Filter away 50/60Hz electrical pickup,
|
||||||
|
// and 100/120Hz room lighting optical pickup
|
||||||
|
ir_heart_signal = ir_filter(i);
|
||||||
|
// Filter away the large DC
|
||||||
|
// component from the sensor */
|
||||||
|
ir_heart_ac_signal = ir_heart_signal - dc_estimator(&ir_2nd_dc_register, ir_heart_signal);
|
||||||
|
|
||||||
|
/* Bring the IR signal into range through the second opamp */
|
||||||
|
if (i >= 4095)
|
||||||
|
{
|
||||||
|
if (ir_dc_offset > 100)
|
||||||
|
ir_dc_offset--;
|
||||||
|
}
|
||||||
|
else if (i < 100)
|
||||||
|
{
|
||||||
|
if (ir_dc_offset < 4095)
|
||||||
|
ir_dc_offset++;
|
||||||
|
}
|
||||||
|
|
||||||
|
sq_ir_heart_ac_signal += (mul16(ir_heart_ac_signal, ir_heart_ac_signal) >> 10);
|
||||||
|
|
||||||
|
//Tune the LED intensity to keep
|
||||||
|
//the signal produced by the first
|
||||||
|
//stage within our target range.
|
||||||
|
//We don't really care what the
|
||||||
|
//exact values from the first
|
||||||
|
//stage are. They need to be
|
||||||
|
//quite high, because a weak
|
||||||
|
//signal will give poor results
|
||||||
|
//in later stages. However, the
|
||||||
|
//exact value only has to be
|
||||||
|
//within the range that can be
|
||||||
|
//handled properly by the next
|
||||||
|
//stage. */
|
||||||
|
|
||||||
|
if (ir_sample > FIRST_STAGE_TARGET_HIGH
|
||||||
|
||
|
||||||
|
ir_sample < FIRST_STAGE_TARGET_LOW)
|
||||||
|
{
|
||||||
|
//We are out of the target range
|
||||||
|
//Starting kicking the LED
|
||||||
|
//intensity in the right
|
||||||
|
//direction to bring us back
|
||||||
|
//into range. We use fine steps
|
||||||
|
//when we are close to the target
|
||||||
|
//range, and coarser steps when
|
||||||
|
//we are far away.
|
||||||
|
if (ir_sample > FIRST_STAGE_TARGET_HIGH)
|
||||||
|
{
|
||||||
|
if (ir_sample >= FIRST_STAGE_TARGET_HIGH_FINE)
|
||||||
|
ir_LED_level -= FIRST_STAGE_STEP;
|
||||||
|
else
|
||||||
|
ir_LED_level -= FIRST_STAGE_FINE_STEP;
|
||||||
|
// Clamp to the range of the DAC
|
||||||
|
if (ir_LED_level < 0)
|
||||||
|
ir_LED_level = 0;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if (ir_sample < FIRST_STAGE_TARGET_LOW_FINE)
|
||||||
|
ir_LED_level += FIRST_STAGE_STEP;
|
||||||
|
else
|
||||||
|
ir_LED_level += FIRST_STAGE_FINE_STEP;
|
||||||
|
// Clamp to the range of the DAC
|
||||||
|
if (ir_LED_level > 4095)
|
||||||
|
ir_LED_level = 4095;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* UART Transmission - IR heart signals */
|
||||||
|
switch (scope_type)
|
||||||
|
{
|
||||||
|
case SCOPE_TYPE_HEART_SIGNALS:
|
||||||
|
i = (ir_heart_ac_signal >> 6) + 128;
|
||||||
|
// Saturate to a byte
|
||||||
|
if (i >= 255) // Make sure the data != 0x0 or 0xFF
|
||||||
|
i = 254; // as 0x0 and 0xFF are used for sync
|
||||||
|
else if (i <= 0) // bytes in the LABVIEW GUI
|
||||||
|
i = 1;
|
||||||
|
|
||||||
|
TXBUF0 = 0x00; // Byte 1 - 0x00 (synchronization byte)
|
||||||
|
while (!(IFG1 & UTXIFG0));
|
||||||
|
TXBUF0 = 0xFF; // Byte 2 - 0xFF (synchronization byte)
|
||||||
|
while (!(IFG1 & UTXIFG0));
|
||||||
|
TXBUF0 = i; // Byte 3 - IR Heart signal (AC only)
|
||||||
|
while (!(IFG1 & UTXIFG0));
|
||||||
|
TXBUF0 = heart_rate_LSB; // Byte 4 - Heart rate data
|
||||||
|
while (!(IFG1 & UTXIFG0));
|
||||||
|
TXBUF0 = SaO2_LSB; // Byte 5 - %SaO2 data
|
||||||
|
while (!(IFG1 & UTXIFG0));
|
||||||
|
TXBUF0 = heart_pulse;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case SCOPE_TYPE_RAW_SIGNALS:
|
||||||
|
while (!(IFG1 & UTXIFG0));
|
||||||
|
TXBUF0 = ir_sample >> 4;
|
||||||
|
break;
|
||||||
|
case SCOPE_TYPE_LED_DRIVE:
|
||||||
|
TXBUF0 = ir_LED_level >> 4;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Track the beating of the heart */
|
||||||
|
heart_signal_sample_counter++;
|
||||||
|
if (pos_edge)
|
||||||
|
{
|
||||||
|
if (edge_debounce < 120)
|
||||||
|
{
|
||||||
|
edge_debounce++;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if (ir_heart_ac_signal < -200)
|
||||||
|
{
|
||||||
|
edge_debounce = 0;
|
||||||
|
pos_edge = 0;
|
||||||
|
display_pulse(0);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if (edge_debounce < 120)
|
||||||
|
{
|
||||||
|
edge_debounce++;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if (ir_heart_ac_signal > 200)
|
||||||
|
{
|
||||||
|
edge_debounce = 0;
|
||||||
|
pos_edge = 1;
|
||||||
|
display_pulse(1);
|
||||||
|
//display_correcting(1, 0);
|
||||||
|
if (++heart_beat_counter >= 3)
|
||||||
|
{
|
||||||
|
log_heart_signal_sample_counter = heart_signal_sample_counter;
|
||||||
|
log_sq_ir_heart_ac_signal = sq_ir_heart_ac_signal;
|
||||||
|
log_sq_vs_heart_ac_signal = sq_vs_heart_ac_signal;
|
||||||
|
heart_signal_sample_counter = 0;
|
||||||
|
sq_ir_heart_ac_signal = 0;
|
||||||
|
sq_vs_heart_ac_signal = 0;
|
||||||
|
heart_beat_counter = 0;
|
||||||
|
_BIC_SR_IRQ(LPM0_bits);
|
||||||
|
// Do a dummy wake up roughly
|
||||||
|
// every 2 seconds
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else //D3 enabled in demoboard
|
||||||
|
{
|
||||||
|
//Immediately enable the IR LED,
|
||||||
|
//to allow time for the
|
||||||
|
//transimpedance amp to settle */
|
||||||
|
DAC12_0CTL &= ~DAC12ENC;
|
||||||
|
P2OUT &= ~BIT2; //turn on source for D3
|
||||||
|
DAC12_0CTL |= DAC12OPS; // Disable visible LED, enable IR LED
|
||||||
|
DAC12_0CTL |= DAC12ENC;
|
||||||
|
DAC12_0DAT = ir_LED_level;
|
||||||
|
DAC12_1DAT = ir_dc_offset; // Load op-amp offset value for IR
|
||||||
|
P2OUT |= BIT3; //turn off source for D2
|
||||||
|
|
||||||
|
is_IR = 1; // IR LED ON
|
||||||
|
|
||||||
|
vs_sample = ADC12MEM0; //Read the visible LED results
|
||||||
|
i = ADC12MEM1;
|
||||||
|
|
||||||
|
//Enable the next conversion sequence.
|
||||||
|
//The sequence is started by TA1
|
||||||
|
ADC12CTL0 &= ~ENC;
|
||||||
|
ADC12CTL0 |= ENC;
|
||||||
|
|
||||||
|
|
||||||
|
//Filter away 50/60Hz electrical
|
||||||
|
//pickup, and 100/120Hz room
|
||||||
|
//lighting optical pickup */
|
||||||
|
vs_heart_signal = vs_filter(i);
|
||||||
|
//Filter away the large DC
|
||||||
|
//component from the sensor */
|
||||||
|
vs_heart_ac_signal = vs_heart_signal - dc_estimator(&vs_2nd_dc_register, vs_heart_signal);
|
||||||
|
|
||||||
|
/* Bring the VS signal into range through the second opamp */
|
||||||
|
if (i >= 4095)
|
||||||
|
{
|
||||||
|
if (vs_dc_offset > 100)
|
||||||
|
vs_dc_offset--;
|
||||||
|
}
|
||||||
|
else if (i < 100)
|
||||||
|
{
|
||||||
|
if (vs_dc_offset < 4095)
|
||||||
|
vs_dc_offset++;
|
||||||
|
}
|
||||||
|
|
||||||
|
sq_vs_heart_ac_signal += (mul16(vs_heart_ac_signal, vs_heart_ac_signal) >> 10);
|
||||||
|
|
||||||
|
if (vs_sample > FIRST_STAGE_TARGET_HIGH
|
||||||
|
||
|
||||||
|
vs_sample < FIRST_STAGE_TARGET_LOW)
|
||||||
|
{
|
||||||
|
/* We are out of the target range */
|
||||||
|
//display_correcting(1, 1);
|
||||||
|
if (vs_sample > FIRST_STAGE_TARGET_HIGH)
|
||||||
|
{
|
||||||
|
if (vs_sample >= FIRST_STAGE_TARGET_HIGH_FINE)
|
||||||
|
vs_LED_level -= FIRST_STAGE_STEP;
|
||||||
|
else
|
||||||
|
vs_LED_level -= FIRST_STAGE_FINE_STEP;
|
||||||
|
if (vs_LED_level < 0)
|
||||||
|
vs_LED_level = 0;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
if (vs_sample < FIRST_STAGE_TARGET_LOW_FINE)
|
||||||
|
vs_LED_level += FIRST_STAGE_STEP;
|
||||||
|
else
|
||||||
|
vs_LED_level += FIRST_STAGE_FINE_STEP;
|
||||||
|
if (vs_LED_level > 4095)
|
||||||
|
vs_LED_level = 4095;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
#pragma vector=ADC_VECTOR
|
||||||
|
__interrupt void ADC12ISR(void)
|
||||||
|
{
|
||||||
|
ADC12IFG &= ~BIT1; // Clear the ADC12 interrupt flag
|
||||||
|
DAC12_0DAT = 0; // Turn OFF the LED
|
||||||
|
DAC12_1DAT = 0;
|
||||||
|
// Turn OFF the H-Bridge completely
|
||||||
|
if(is_IR) // If IR LED was ON in TA0 ISR
|
||||||
|
P2OUT |= BIT2; // P2.2 = 1
|
||||||
|
else // Else if VS LED ON in TA0 ISR
|
||||||
|
P2OUT |= BIT3; // P2.3 = 1
|
||||||
|
}
|
||||||
|
|
||||||
|
int16_t ir_filter(int16_t sample)
|
||||||
|
{
|
||||||
|
static int16_t buf[32];
|
||||||
|
static int offset = 0;
|
||||||
|
int32_t z;
|
||||||
|
int i;
|
||||||
|
//Filter hard above a few Hertz,
|
||||||
|
//using a symmetric FIR.
|
||||||
|
//This has benign phase
|
||||||
|
//characteristics */
|
||||||
|
buf[offset] = sample;
|
||||||
|
z = mul16(coeffs[11], buf[(offset - 11) & 0x1F]);
|
||||||
|
for (i = 0; i < 11; i++)
|
||||||
|
z += mul16(coeffs[i], buf[(offset - i) & 0x1F] + buf[(offset - 22 + i) & 0x1F]);
|
||||||
|
offset = (offset + 1) & 0x1F;
|
||||||
|
return z >> 15;
|
||||||
|
}
|
||||||
|
|
||||||
|
int16_t vs_filter(int16_t sample)
|
||||||
|
{
|
||||||
|
static int16_t buf[32];
|
||||||
|
static int offset = 0;
|
||||||
|
int32_t z;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
//Filter hard above a few Hertz,
|
||||||
|
//using a symmetric FIR.
|
||||||
|
//This has benign phase
|
||||||
|
//characteristics */
|
||||||
|
buf[offset] = sample;
|
||||||
|
z = mul16(coeffs[11], buf[(offset - 11) & 0x1F]);
|
||||||
|
for (i = 0; i < 11; i++)
|
||||||
|
z += mul16(coeffs[i], buf[(offset - i) & 0x1F] + buf[(offset - 22 + i) & 0x1F]);
|
||||||
|
offset = (offset + 1) & 0x1F;
|
||||||
|
return z >> 15;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*unsigned long isqrt32(register unsigned long h)
|
||||||
|
{
|
||||||
|
register unsigned long x;
|
||||||
|
register unsigned long y;
|
||||||
|
register int i;
|
||||||
|
|
||||||
|
//Calculate a 32 bit bit square
|
||||||
|
//root of a 32 bit integer,
|
||||||
|
//where the top 16 bits
|
||||||
|
//of the result is the integer
|
||||||
|
//part of the result, and the
|
||||||
|
//low 16 bits are fractional.
|
||||||
|
x =
|
||||||
|
y = 0;
|
||||||
|
for (i = 0; i < 32; i++)
|
||||||
|
{
|
||||||
|
x = (x << 1) | 1;
|
||||||
|
if (y < x)
|
||||||
|
x -= 2;
|
||||||
|
else
|
||||||
|
y -= x;
|
||||||
|
x++;
|
||||||
|
y <<= 1;
|
||||||
|
if ((h & 0x80000000))
|
||||||
|
y |= 1;
|
||||||
|
h <<= 1;
|
||||||
|
y <<= 1;
|
||||||
|
if ((h & 0x80000000))
|
||||||
|
y |= 1;
|
||||||
|
h <<= 1;
|
||||||
|
}
|
||||||
|
return x;
|
||||||
|
} */
|
||||||
|
|
||||||
|
int16_t dc_estimator(register int32_t *p, register int16_t x)
|
||||||
|
{
|
||||||
|
/* Noise shaped DC estimator. */
|
||||||
|
*p += ((((int32_t) x << 16) - *p) >> 9);
|
||||||
|
return (*p >> 16);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* LCD number Display */
|
||||||
|
void display_number(int value, int start, int width)
|
||||||
|
{
|
||||||
|
/*
|
||||||
|
unsigned int i;
|
||||||
|
unsigned int Output;
|
||||||
|
char *pLCD = (char *)&LCDMEM[7-start];
|
||||||
|
|
||||||
|
for (i = 16, Output = 0; i; i--) // BCD Conversion, 16-Bit
|
||||||
|
{
|
||||||
|
Output = __bcd_add_short(Output, Output);
|
||||||
|
if (value & 0x8000)
|
||||||
|
Output = __bcd_add_short(Output, 1);
|
||||||
|
value <<= 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
for (i = 0; i < width; i++) // Process 4 digits
|
||||||
|
{
|
||||||
|
*pLCD++ = hex_table[Output & 0x0f]; // Segments to LCD
|
||||||
|
Output >>= 4; // Process next digit
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
|
||||||
|
value = itobcd(value);
|
||||||
|
|
||||||
|
if(start == 3){
|
||||||
|
// Display heart rate
|
||||||
|
LCDMEM[2] = char_gen_10_11[value & 0x0f]; // Display current heart rate units -> LCD Digit 11
|
||||||
|
LCDMEM[3] = char_gen_10_11[(value & 0xf0) >> 4]; // tens -> LCD Digit 10
|
||||||
|
LCDMEM[4] = char_gen_8_9[(value & 0xf00) >> 8]; // hundreds -> LCD Digit 9
|
||||||
|
}
|
||||||
|
else if(start == 7){
|
||||||
|
// Display oxigenation
|
||||||
|
LCDMEM[7] = ((char)(char_gen_1_7[value & 0x0f]>>8)); // LCD -> Digit 7 High Byte
|
||||||
|
LCDMEM[6] = ((char)(char_gen_1_7[value & 0x0f]&0x00FF)); // LCD -> Digit 7 Low Byte
|
||||||
|
LCDMEM[9] = ((char)(char_gen_1_7[((value & 0xf0) >> 4)]>>8)); // LCD -> Digit 6 High Byte
|
||||||
|
LCDMEM[8] = ((char)(char_gen_1_7[((value & 0xf0) >> 4)]&0x00FF)); // LCD -> Digit 6 Low Byte
|
||||||
|
// Don't display values bigger than 99
|
||||||
|
//LCDMEM[11] = ((char)(char_gen_1_7[((value & 0xf00) >> 8)]>>8)); // LCD -> Digit 5 High Byte
|
||||||
|
//LCDMEM[10] = ((char)(char_gen_1_7[((value & 0xf00) >> 8)]&0x00FF)); // LCD -> Digit 5 Low Byte
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
/* LCD Pulse Display */
|
||||||
|
void display_pulse(int on)
|
||||||
|
{
|
||||||
|
if (on) {
|
||||||
|
LCDMEM[1] = 0xF0; // Heart beat detected enable "<^>" on LCD
|
||||||
|
heart_pulse = 1;
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
heart_pulse = 0;
|
||||||
|
LCDMEM[1] = 0x00; // Disable "<^>" on LCD for blinking effect
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* LCD Correcting info Display */
|
||||||
|
void display_correcting(int x, int on)
|
||||||
|
{
|
||||||
|
if (on)
|
||||||
|
LCDMEM[3] |= ((x) ? seg_a : seg_d);
|
||||||
|
else
|
||||||
|
LCDMEM[3] &= ~((x) ? seg_a : seg_d);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Configure LCD */
|
||||||
|
void set_LCD(void)
|
||||||
|
{
|
||||||
|
volatile unsigned int i;
|
||||||
|
for(i=0;i<20;i++) // Clear LCD memory
|
||||||
|
{
|
||||||
|
LCDMEM[i] = 0x00;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Turn on the COM0-COM3 and R03-R33 pins */
|
||||||
|
P5SEL |= (BIT7 | BIT6 | BIT5 | BIT4 | BIT3 | BIT2);
|
||||||
|
|
||||||
|
LCDCTL = 0x7F; // Selected function: Analog generator on
|
||||||
|
// Low impedance of AG
|
||||||
|
// 4Mux active
|
||||||
|
// all outputs are Seg
|
||||||
|
// S0-S23 are LCD segment lines
|
||||||
|
BTCTL = BTFRFQ0; // Start Basic Timer 1s + LCD 64Hz
|
||||||
|
}
|
||||||
|
|
||||||
Loading…
Reference in New Issue