+++ /dev/null
-#include "MagnetSensor.h"
-
-uint8_t InitMagSensor(uint8_t Addr, uint16_t* Tref, float* SensX, float* SensY, float* SensZ)
-{
-
- // Write register command, AH = 0x00, AL = 0x5C, Hall plate spinning rate = DEFAULT, GAIN_SEL = 5(0x60, 0x00, 0x5C, 0x00)
- // Address register, (0x00 << 2)
- uint8_t txBuffer[4] = {0x60,0x00,0x5C,0x00};
- uint8_t status;uint8_t status2;
- uint8_t ReadReg[3];
- uint8_t Gain,Res_x,Res_y,Res_z;
-
-
- txBuffer[0] = 0x60;
- txBuffer[1] = 0x00;
- txBuffer[2] = 0x5C;
- txBuffer[3] = 0x00;
-
- status2 = twi_writeTo(Addr, txBuffer, 4,1, true);
- twi_readFrom(Addr, &status, 1, true);
-
- // Write register command, AH = 0x02, AL = 0xB4, RES for magnetic measurement = 1(0x60, 0x02, 0xB4, 0x08)
- // Address register, (0x02 << 2)
- txBuffer[1] = 0x02;
- txBuffer[2] = 0xB4;
- txBuffer[3] = 0x08;
- twi_writeTo(Addr,txBuffer,4,1,true);
- twi_readFrom(Addr, &status, 1, true);
-
- txBuffer[0] = 0x50;
- txBuffer[1] = 0x90;
- twi_writeTo(Addr,txBuffer,2,1,true);
- twi_readFrom(Addr, ReadReg, 3, true);
- uint16_t T_ref = ReadReg[1]<<8 | ReadReg[2];
- *Tref = T_ref;
- //Read Gain;
- txBuffer[1] = 0x00;
- twi_writeTo(Addr,txBuffer,2,1,true);
- twi_readFrom(Addr, ReadReg, 3, true);
-
- Gain = (ReadReg[2] & 0x70) >>4;
-
- //Read Resolution;
- txBuffer[1] = 0x08; //Read Gain;
- twi_writeTo(Addr,txBuffer,2,1,true);
- twi_readFrom(Addr, ReadReg, 3, true);
-
- Res_x = (ReadReg[1] & 0x6) >>1;
- Res_y = ((ReadReg[1] & 0x1) << 1)|((ReadReg[2] & 0x80) >>7);
- Res_z = (ReadReg[2] & 0x60) >>5;
-
- *SensX = SensitivityXY(Gain,Res_x);
- *SensY = SensitivityXY(Gain,Res_y);
- *SensZ = SensitivityZ(Gain,Res_z);
-
- return status2;
-}
-
-
-void MeasureMagSens(uint8_t Addr, uint16_t Tref, float* SensX, float* SensY, float* SensZ){
- uint8_t MagData[9] = {255,255,255,255,255,255,255,255,255};
- char s[30];
-
- char Num[2];
- sprintf(Num,"%1u",Addr-12);
-
- uint8_t dataTest = 0x3F; // Start Single Measurement
- twi_writeTo(Addr,&dataTest,1,1, true);
-
- uint8_t status_1;
- twi_readFrom(Addr, &status_1, 1, true);
-
- _delay_ms(100);
-
- uint8_t testdata2 = 0x4F;// Read Measured Values
- twi_writeTo(Addr, &testdata2, 1, 1, true);
- twi_readFrom(Addr,MagData, 9, true);
- if (MagData[0] == 3) {
- uint16_t tMag = (uint16_t)( MagData[1] * 256 + MagData[2]);
- int16_t xMag = MagData[3] * 256 + MagData[4];
- int16_t yMag = MagData[5] * 256 + MagData[6];
- int16_t zMag = MagData[7] * 256 + MagData[8];
- int16_t temp_temp = (uint16_t)(tMag) - (uint16_t)(Tref);
- float Temperature = 35.0 + (temp_temp/45.2);
- uputs("M");uputs(Num);uputs("_T ");
- sprintf(s,"%4.2f",Temperature);
- uputsnl(s);
- uputs("M");uputs(Num);uputs("_X ");
- sprintf(s,"%4.3f",((float)xMag*(*SensX))); //muT
- uputsnl(s);
- uputs("M");uputs(Num);uputs("_Y ");
- sprintf(s,"%4.3f",((float)yMag*(*SensY))); //muT
- uputsnl(s);
- uputs("M");uputs(Num);uputs("_Z ");
- sprintf(s,"%4.3f",((float)zMag*(*SensZ))); //muT
- uputsnl(s);
- uputs("ERR Mag ");uputs(Num);uputsnl(" NO"); // ERROR INFORMATION FOR EPICS
- } else {
- uputs("ERR Mag ");uputs(Num);uputsnl(" CONNECTION");
- }
-}
-
-float SensitivityXY(uint8_t Gain, uint8_t Res){
- float Sens =0.805;
- /*if (Gain != 0) {
- for (int i=1; i<=Gain;i++){
- if (i<3) {
- logVal = 1;
- } else if (i<5) {
- logVal = 2;
- } else {
- logVal = 3;
- }
- Sens = roundf((Sens - 0.161/((float)logVal)) * 1000) / 1000;
- }
- sprintf(s,"LOG: %f",Sens);
- uputsnl(s);
- }*/
-
- switch(Gain) {
- case 0: Sens=0.805; break;
- case 1: Sens=0.644; break;
- case 2: Sens=0.483; break;
- case 3: Sens=0.403; break;
- case 4: Sens=0.322; break;
- case 5: Sens=0.268; break;
- case 6: Sens=0.215; break;
- default: Sens=0.161; break;
- }
-
-
- return Sens*(float)pow(2,Res);
-}
-
-float SensitivityZ(uint8_t Gain, uint8_t Res){
- float Sens =0.805;
- switch(Gain) {
- case 0: Sens=1.468; break;
- case 1: Sens=1.174; break;
- case 2: Sens=0.881; break;
- case 3: Sens=0.734; break;
- case 4: Sens=0.587; break;
- case 5: Sens=0.489; break;
- case 6: Sens=0.391; break;
- default: Sens=0.294; break;
- }
-
-
- return Sens*(float)pow(2,Res);
-}
+++ /dev/null
-#include "main.h"
-
-uint8_t InitMagSensor(uint8_t Addr, uint16_t* Tref, float *SensX, float* SensY, float *SensZ);
-void MeasureMagSens(uint8_t Addr, uint16_t Tref, float* SensX, float* SensY, float* SensZ);
-float SensitivityXY(uint8_t Gain, uint8_t Res);
-float SensitivityZ(uint8_t Gain, uint8_t Res);
+++ /dev/null
-# Hey Emacs, this is a -*- makefile -*-\r
-\r
-# AVR-GCC Makefile template, derived from the WinAVR template (which\r
-# is public domain), believed to be neutral to any flavor of "make"\r
-# (GNU make, BSD make, SysV make)\r
-\r
-\r
-MCU = atmega168p\r
-FORMAT = ihex\r
-TARGET = main\r
-SRC = $(TARGET).c uart/uart.c twi/twi.c MagnetSensor.c\r
-ASRC = \r
-OPT = 2\r
-\r
-# Name of this Makefile (used for "make depend").\r
-MAKEFILE = Makefile\r
-\r
-# Debugging format.\r
-# Native formats for AVR-GCC's -g are stabs [default], or dwarf-2.\r
-# AVR (extended) COFF requires stabs, plus an avr-objcopy run.\r
-DEBUG = stabs\r
-\r
-# Compiler flag to set the C Standard level.\r
-# c89 - "ANSI" C\r
-# gnu89 - c89 plus GCC extensions\r
-# c99 - ISO C99 standard (not yet fully implemented)\r
-# gnu99 - c99 plus GCC extensions\r
-CSTANDARD = -std=gnu99\r
-\r
-# Place -D or -U options here\r
-CDEFS = -DF_CPU=16000000\r
-\r
-# Place -I options here\r
-CINCS =\r
-\r
-\r
-CDEBUG = -g$(DEBUG)\r
-CWARN = -Wall -Wstrict-prototypes \r
-CTUNING = -funsigned-char -funsigned-bitfields -fpack-struct -fshort-enums -Wl,--relax\r
-#CEXTRA = -Wa,-adhlns=$(<:.c=.lst)\r
-CFLAGS = $(CDEBUG) $(CDEFS) $(CINCS) -O$(OPT) $(CWARN) $(CSTANDARD) $(CEXTRA) $(CTUNING)\r
-\r
-\r
-#ASFLAGS = -Wa,-adhlns=$(<:.S=.lst),-gstabs \r
-\r
-\r
-#Additional libraries.\r
-\r
-# Minimalistic printf version\r
-PRINTF_LIB_MIN = -Wl,-u,vfprintf -lprintf_min\r
-\r
-# Floating point printf version (requires MATH_LIB = -lm below)\r
-PRINTF_LIB_FLOAT = -Wl,-u,vfprintf -lprintf_flt\r
-\r
-PRINTF_LIB = \r
-\r
-# Minimalistic scanf version\r
-SCANF_LIB_MIN = -Wl,-u,vfscanf -lscanf_min\r
-\r
-# Floating point + %[ scanf version (requires MATH_LIB = -lm below)\r
-SCANF_LIB_FLOAT = -Wl,-u,vfscanf -lscanf_flt\r
-\r
-SCANF_LIB = \r
-\r
-MATH_LIB = -lm\r
-\r
-# External memory options\r
-\r
-# 64 KB of external RAM, starting after internal RAM (ATmega128!),\r
-# used for variables (.data/.bss) and heap (malloc()).\r
-#EXTMEMOPTS = -Wl,--section-start,.data=0x801100,--defsym=__heap_end=0x80ffff\r
-\r
-# 64 KB of external RAM, starting after internal RAM (ATmega128!),\r
-# only used for heap (malloc()).\r
-#EXTMEMOPTS = -Wl,--defsym=__heap_start=0x801100,--defsym=__heap_end=0x80ffff\r
-\r
-EXTMEMOPTS =\r
-\r
-#LDMAP = $(LDFLAGS) -Wl,-Map=$(TARGET).map,--cref\r
-LDFLAGS = $(EXTMEMOPTS) $(LDMAP) $(PRINTF_LIB_FLOAT) $(SCANF_LIB) $(MATH_LIB)\r
-\r
-\r
-# Programming support using avrdude. Settings and variables.\r
-\r
-AVRDUDE_PROGRAMMER = dragon_jtag\r
-AVRDUDE_PORT = usb\r
-\r
-AVRDUDE_WRITE_FLASH = -U flash:w:$(TARGET).hex\r
-#AVRDUDE_WRITE_EEPROM = -U eeprom:w:$(TARGET).eep\r
-\r
-\r
-# Uncomment the following if you want avrdude's erase cycle counter.\r
-# Note that this counter needs to be initialized first using -Yn,\r
-# see avrdude manual.\r
-#AVRDUDE_ERASE_COUNTER = -y\r
-\r
-# Uncomment the following if you do /not/ wish a verification to be\r
-# performed after programming the device.\r
-AVRDUDE_NO_VERIFY = -V\r
-\r
-# Increase verbosity level. Please use this when submitting bug\r
-# reports about avrdude. See <http://savannah.nongnu.org/projects/avrdude> \r
-# to submit bug reports.\r
-#AVRDUDE_VERBOSE = -v -v\r
-\r
-AVRDUDE_BASIC = -p $(MCU) -P $(AVRDUDE_PORT) -c $(AVRDUDE_PROGRAMMER)\r
-AVRDUDE_FLAGS = $(AVRDUDE_BASIC) $(AVRDUDE_NO_VERIFY) $(AVRDUDE_VERBOSE) $(AVRDUDE_ERASE_COUNTER)\r
-\r
-\r
-CC = avr-gcc\r
-OBJCOPY = avr-objcopy\r
-OBJDUMP = avr-objdump\r
-SIZE = avr-size\r
-NM = avr-nm\r
-AVRDUDE = avrdude\r
-REMOVE = rm -f\r
-MV = mv -f\r
-\r
-# Define all object files.\r
-OBJ = $(SRC:.c=.o) $(ASRC:.S=.o) \r
-\r
-# Define all listing files.\r
-LST = $(ASRC:.S=.lst) $(SRC:.c=.lst)\r
-\r
-# Combine all necessary flags and optional flags.\r
-# Add target processor to flags.\r
-ALL_CFLAGS = -mmcu=$(MCU) -I. $(CFLAGS)\r
-ALL_ASFLAGS = -mmcu=$(MCU) -I. -x assembler-with-cpp $(ASFLAGS)\r
-\r
-\r
-# Default target.\r
-all: build\r
-\r
-build: elf hex eep\r
-\r
-elf: $(TARGET).elf\r
-hex: $(TARGET).hex\r
-eep: $(TARGET).eep\r
-lss: $(TARGET).lss \r
-sym: $(TARGET).sym\r
-\r
-\r
-# Program the device. \r
-program: $(TARGET).hex $(TARGET).eep\r
- $(AVRDUDE) $(AVRDUDE_FLAGS) $(AVRDUDE_WRITE_FLASH) $(AVRDUDE_WRITE_EEPROM)\r
-\r
-\r
-size: \r
- $(SIZE) -C --mcu=$(MCU) $(TARGET).elf \r
-\r
-# Convert ELF to COFF for use in debugging / simulating in AVR Studio or VMLAB.\r
-COFFCONVERT=$(OBJCOPY) --debugging \\r
---change-section-address .data-0x800000 \\r
---change-section-address .bss-0x800000 \\r
---change-section-address .noinit-0x800000 \\r
---change-section-address .eeprom-0x810000 \r
-\r
-\r
-coff: $(TARGET).elf\r
- $(COFFCONVERT) -O coff-avr $(TARGET).elf $(TARGET).cof\r
-\r
-\r
-extcoff: $(TARGET).elf\r
- $(COFFCONVERT) -O coff-ext-avr $(TARGET).elf $(TARGET).cof\r
-\r
-\r
-.SUFFIXES: .elf .hex .eep .lss .sym\r
-\r
-.elf.hex:\r
- $(OBJCOPY) -O $(FORMAT) -R .eeprom $< $@\r
-\r
-.elf.eep:\r
- -$(OBJCOPY) -j .eeprom --set-section-flags=.eeprom="alloc,load" \\r
- --change-section-lma .eeprom=0 -O $(FORMAT) $< $@\r
-\r
-# Create extended listing file from ELF output file.\r
-.elf.lss:\r
- $(OBJDUMP) -h -S $< > $@\r
-\r
-# Create a symbol table from ELF output file.\r
-.elf.sym:\r
- $(NM) -n $< > $@\r
-\r
-\r
-\r
-# Link: create ELF output file from object files.\r
-$(TARGET).elf: $(OBJ)\r
- $(CC) $(ALL_CFLAGS) $(OBJ) --output $@ $(LDFLAGS)\r
-\r
-\r
-# Compile: create object files from C source files.\r
-.c.o:\r
- $(CC) -c $(ALL_CFLAGS) $< -o $@ \r
-\r
-\r
-# Compile: create assembler files from C source files.\r
-.c.s:\r
- $(CC) -S $(ALL_CFLAGS) $< -o $@\r
-\r
-\r
-# Assemble: create object files from assembler source files.\r
-.S.o:\r
- $(CC) -c $(ALL_ASFLAGS) $< -o $@\r
-\r
-\r
-\r
-# Target: clean project.\r
-clean:\r
- $(REMOVE) $(TARGET).hex $(TARGET).eep $(TARGET).cof $(TARGET).elf \\r
- $(TARGET).map $(TARGET).sym $(TARGET).lss \\r
- $(OBJ) $(LST) $(SRC:.c=.s) $(SRC:.c=.d)\r
-\r
-depend:\r
- if grep '^# DO NOT DELETE' $(MAKEFILE) >/dev/null; \\r
- then \\r
- sed -e '/^# DO NOT DELETE/,$$d' $(MAKEFILE) > \\r
- $(MAKEFILE).$$$$ && \\r
- $(MV) $(MAKEFILE).$$$$ $(MAKEFILE); \\r
- fi\r
- echo '# DO NOT DELETE THIS LINE -- make depend depends on it.' \\r
- >> $(MAKEFILE); \\r
- $(CC) -M -mmcu=$(MCU) $(CDEFS) $(CINCS) $(SRC) $(ASRC) >> $(MAKEFILE)\r
-\r
-.PHONY: all build elf hex eep lss sym program coff extcoff clean depend program_bootloader program_arduino program_leo\r
-\r
-program_bootloader: all\r
- dfu-programmer $(MCU) erase && dfu-programmer $(MCU) flash $(TARGET).hex && dfu-programmer $(MCU) start\r
-\r
-# program_arduino: all\r
-# avrdude -patmega32u4 -cavr109 -P$(PORT) -b 57600 -D -Uflash:w:$(TARGET).hex:i\r
-\r
-program_leo: all\r
- avrdude -patmega32u4 -cavr109 -P/dev/ttyACM0 -b57600 -D -Uflash:w:$(TARGET).hex:i\r
+++ /dev/null
-/*\r
- * main.c\r
- *\r
- * Created on: 07.03.2017\r
- * Author: Adrian Weber\r
- */\r
-#include "main.h"\r
-\r
-\r
-int main(void)\r
-{ char s[30];\r
- uint8_t Status[4]={0,0,0,0};\r
- uint8_t Status_Mag[4]={0,0,0,0};\r
- uint16_t TRef[4]={0,0,0,0};\r
- float SensX[4];\r
- float SensY[4];\r
- float SensZ[4];\r
- \r
- //For CLK setting\r
- CLKPR = (0<<CLKPCE); // No prescale\r
- CLKPR = 0x00; //prescaler 2\r
- PRR = 0;\r
- //Init UART\r
- uinit();\r
-\r
- //Init I2C/TWI\r
- twi_init();\r
-\r
- //Init Magnetic field Sensor\r
- Status[0] = InitMagSensor(ADDR_MAG_0, &TRef[0], &SensX[0], &SensY[0], &SensZ[0]);\r
- Status[1] = InitMagSensor(ADDR_MAG_1, &TRef[1], &SensX[1], &SensY[1], &SensZ[1]);\r
- Status[2] = InitMagSensor(ADDR_MAG_2, &TRef[2], &SensX[2], &SensY[2], &SensZ[2]);\r
- Status[3] = InitMagSensor(ADDR_MAG_3, &TRef[3], &SensX[3], &SensY[3], &SensZ[3]);\r
-\r
- // sprintf(s,"%u", Status[0]);\r
- //uputs(s);\r
- _delay_ms(300);\r
-\r
- while (1)\r
- { \r
- if (Status[0] == 0) { MeasureMagSens(ADDR_MAG_0, TRef[0], &SensX[0], &SensY[0], &SensZ[0]);}\r
- else { uputsnl("ERR Mag 0 NO_DEVICE"); }\r
- if (Status[1] == 0) { MeasureMagSens(ADDR_MAG_1, TRef[1], &SensX[1], &SensY[1], &SensZ[1]);}\r
- else { uputsnl("ERR Mag 1 NO_DEVICE"); }\r
- if (Status[2] == 0) { MeasureMagSens(ADDR_MAG_2, TRef[2], &SensX[2], &SensY[2], &SensZ[2]);}\r
- else { uputsnl("ERR Mag 2 NO_DEVICE"); }\r
- if (Status[3] == 0) { MeasureMagSens(ADDR_MAG_3, TRef[3], &SensX[3], &SensY[3], &SensZ[3]);}\r
- else { uputsnl("ERR Mag 3 NO_DEVICE"); }\r
-\r
- _delay_ms(500);\r
-\r
- }\r
- cli();\r
- return 0;\r
-}\r
-\r
+++ /dev/null
-/*\r
- * main.h\r
- *\r
- * Created on: 07.03.2017\r
- * Author: Adrian Weber\r
- */\r
-\r
-#ifndef MAIN_H_\r
-#define MAIN_H_\r
-\r
-#include <avr/io.h>\r
-#include <util/delay.h>\r
-#include <string.h>\r
-#include <stdlib.h>\r
-#include <stdio.h>\r
-#include <stdint.h>\r
-#include <stdbool.h>\r
-#include <inttypes.h>\r
-#include <math.h>\r
-#include "uart/uart.h"\r
-#include "MagnetSensor.h"\r
-#include "twi/twi.h"\r
-#include <avr/interrupt.h>\r
-#include <avr/pgmspace.h>\r
-\r
-\r
-#ifndef F_CPU\r
-#define F_CPU 16000000\r
-#endif\r
-\r
-# define USART_BAUDRATE 19200\r
-# define BAUD_PRESCALE (unsigned int)(1.0 * F_CPU / USART_BAUDRATE / 16 - 0.5);\r
-\r
-#define ADDR_MAG_0 0x0C\r
-#define ADDR_MAG_1 0x0D\r
-#define ADDR_MAG_2 0x0E\r
-#define ADDR_MAG_3 0x0F\r
-\r
-\r
-\r
-\r
-#ifndef __AVR_ATmega168P__\r
-#define __AVR_ATmega168P__\r
-#endif /* MAIN_H_ */\r
-\r
-\r
-#endif\r
jspc29 / avr.git / commitdiff