60
									
								
								solar_panel.X/crc.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										60
									
								
								solar_panel.X/crc.c
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,60 @@ | |||||||
|  | /** | ||||||
|  |  * \source indirect : http://stackoverflow.com/questions/20878300/calculate-16-bit-crc-in-java-and-append-it-at-the-end-of-the-byte-array | ||||||
|  |  */ | ||||||
|  |  | ||||||
|  | #include "crc.h" | ||||||
|  |  | ||||||
|  | const uint8_t auchCRCHi[] = { | ||||||
|  | 	0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, | ||||||
|  | 	0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, | ||||||
|  | 	0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, | ||||||
|  | 	0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, | ||||||
|  | 	0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, | ||||||
|  | 	0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, | ||||||
|  | 	0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, | ||||||
|  | 	0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, | ||||||
|  | 	0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, | ||||||
|  | 	0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, | ||||||
|  | 	0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, | ||||||
|  | 	0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, | ||||||
|  | 	0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, | ||||||
|  | 	0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, | ||||||
|  | 	0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, | ||||||
|  | 	0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, | ||||||
|  | 	0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, | ||||||
|  | 	0x40 | ||||||
|  | }; | ||||||
|  | const uint8_t auchCRCLo[] = { | ||||||
|  | 	0x00, 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06, 0x07, 0xC7, 0x05, 0xC5, 0xC4, | ||||||
|  | 	0x04, 0xCC, 0x0C, 0x0D, 0xCD, 0x0F, 0xCF, 0xCE, 0x0E, 0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09, | ||||||
|  | 	0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9, 0x1B, 0xDB, 0xDA, 0x1A, 0x1E, 0xDE, 0xDF, 0x1F, 0xDD, | ||||||
|  | 	0x1D, 0x1C, 0xDC, 0x14, 0xD4, 0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13, 0xD3, | ||||||
|  | 	0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3, 0xF2, 0x32, 0x36, 0xF6, 0xF7, | ||||||
|  | 	0x37, 0xF5, 0x35, 0x34, 0xF4, 0x3C, 0xFC, 0xFD, 0x3D, 0xFF, 0x3F, 0x3E, 0xFE, 0xFA, 0x3A, | ||||||
|  | 	0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38, 0x28, 0xE8, 0xE9, 0x29, 0xEB, 0x2B, 0x2A, 0xEA, 0xEE, | ||||||
|  | 	0x2E, 0x2F, 0xEF, 0x2D, 0xED, 0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6, 0x26, | ||||||
|  | 	0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60, 0x61, 0xA1, 0x63, 0xA3, 0xA2, | ||||||
|  | 	0x62, 0x66, 0xA6, 0xA7, 0x67, 0xA5, 0x65, 0x64, 0xA4, 0x6C, 0xAC, 0xAD, 0x6D, 0xAF, 0x6F, | ||||||
|  | 	0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB, 0x69, 0xA9, 0xA8, 0x68, 0x78, 0xB8, 0xB9, 0x79, 0xBB, | ||||||
|  | 	0x7B, 0x7A, 0xBA, 0xBE, 0x7E, 0x7F, 0xBF, 0x7D, 0xBD, 0xBC, 0x7C, 0xB4, 0x74, 0x75, 0xB5, | ||||||
|  | 	0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71, 0x70, 0xB0, 0x50, 0x90, 0x91, | ||||||
|  | 	0x51, 0x93, 0x53, 0x52, 0x92, 0x96, 0x56, 0x57, 0x97, 0x55, 0x95, 0x94, 0x54, 0x9C, 0x5C, | ||||||
|  | 	0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E, 0x5A, 0x9A, 0x9B, 0x5B, 0x99, 0x59, 0x58, 0x98, 0x88, | ||||||
|  | 	0x48, 0x49, 0x89, 0x4B, 0x8B, 0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C, 0x8C, | ||||||
|  | 	0x44, 0x84, 0x85, 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42, 0x43, 0x83, 0x41, 0x81, 0x80, | ||||||
|  | 	0x40 | ||||||
|  | }; | ||||||
|  |  | ||||||
|  | uint16_t CRC16(const uint8_t *msg, uint16_t length) | ||||||
|  | { | ||||||
|  | 	uint8_t uchCRCHi = 0xFF; /* high byte of CRC initialized */ | ||||||
|  | 	uint8_t uchCRCLo = 0xFF; /* low byte of CRC initialized */ | ||||||
|  | 	uint8_t uIndex; /* will index into CRC lookup table */ | ||||||
|  |  | ||||||
|  | 	while (length--) /* pass through message buffer */ { | ||||||
|  | 		uIndex = uchCRCLo ^ *msg++; /* calculate the CRC */ | ||||||
|  | 		uchCRCLo = uchCRCHi ^ auchCRCHi[uIndex]; | ||||||
|  | 		uchCRCHi = auchCRCLo[uIndex]; | ||||||
|  | 	} | ||||||
|  | 	return (uchCRCHi << 8 | uchCRCLo); | ||||||
|  | } | ||||||
							
								
								
									
										19
									
								
								solar_panel.X/crc.h
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										19
									
								
								solar_panel.X/crc.h
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,19 @@ | |||||||
|  | /************************************************************************//** | ||||||
|  |  * \file	crc.h | ||||||
|  |  * \brief	CRC calculation for Modbus | ||||||
|  |  ***************************************************************************/ | ||||||
|  |  | ||||||
|  | #ifndef CRC_H | ||||||
|  | #define	CRC_H | ||||||
|  |  | ||||||
|  | #include <stdint.h> | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  * Compute the CRC using the MODBUS formulae | ||||||
|  |  * @param msg : message to be sent | ||||||
|  |  * @param length : length of the message | ||||||
|  |  * @return the computed CRC value | ||||||
|  |  */ | ||||||
|  | uint16_t CRC16(const uint8_t *msg, uint16_t length); | ||||||
|  |  | ||||||
|  | #endif /* CRC_H */ | ||||||
							
								
								
									
										55
									
								
								solar_panel.X/measure.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										55
									
								
								solar_panel.X/measure.c
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,55 @@ | |||||||
|  | #include <xc.h> | ||||||
|  |  | ||||||
|  | #include "measure.h" | ||||||
|  | #include "mcc_generated_files/mcc.h" | ||||||
|  |  | ||||||
|  | #define VOLTAGE_CHANNEL 0x5 | ||||||
|  | #define CURRENT_CHANNEL 0x6 | ||||||
|  | #define ADC_RESOLUTION  4096 - 1 | ||||||
|  | #define ADC_REFH        3300 | ||||||
|  | #define GAIN            66 | ||||||
|  | #define RESISTOR        3 | ||||||
|  |  | ||||||
|  | // Number of samples to do the averaging during measures | ||||||
|  | #define AVERAGE_SAMPLES 8 | ||||||
|  |  | ||||||
|  | uint16_t samplesVoltage[AVERAGE_SAMPLES]; | ||||||
|  | uint16_t samplesCurrent[AVERAGE_SAMPLES]; | ||||||
|  |  | ||||||
|  |  | ||||||
|  | void adc_init(void) | ||||||
|  | { | ||||||
|  | 	// TODO -> complete adc initialisation | ||||||
|  |     offsetCurrent = measure_current(0); | ||||||
|  |  | ||||||
|  | } | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  * Read one ADC channel. This function is only | ||||||
|  |  * local to this file. | ||||||
|  |  * | ||||||
|  |  * @param channel : the channel to be measured | ||||||
|  |  * @return the ADC read value | ||||||
|  |  */ | ||||||
|  | static uint16_t measure_adc(uint8_t channel) | ||||||
|  | { | ||||||
|  | 	return (uint16_t) (ADC_GetConversion(channel)); | ||||||
|  | } | ||||||
|  |  | ||||||
|  | uint16_t measure_voltage() | ||||||
|  | { | ||||||
|  | 	uint16_t m = measure_adc(VOLTAGE_CHANNEL); | ||||||
|  |     m /= 20; // TODO Explain why 20 | ||||||
|  |     return m; | ||||||
|  | } | ||||||
|  |  | ||||||
|  | uint16_t measure_current(uint16_t offset) | ||||||
|  | { | ||||||
|  | 	uint16_t m = measure_adc(CURRENT_CHANNEL); | ||||||
|  |     m -= offset; | ||||||
|  |     if(m <= 0){ | ||||||
|  |         m = 0; | ||||||
|  |     } | ||||||
|  |     m /= GAIN; | ||||||
|  |     return m; | ||||||
|  | } | ||||||
							
								
								
									
										39
									
								
								solar_panel.X/measure.h
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										39
									
								
								solar_panel.X/measure.h
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,39 @@ | |||||||
|  | /************************************************************************//** | ||||||
|  |  * \file	measure.h | ||||||
|  |  * \brief	Measuring current and voltage from the solar panel | ||||||
|  |  ***************************************************************************/ | ||||||
|  |  | ||||||
|  | #ifndef MEASURE_H | ||||||
|  | #define	MEASURE_H | ||||||
|  |  | ||||||
|  | #include <stdint.h> | ||||||
|  |  | ||||||
|  | static uint16_t offsetCurrent; | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  * Initialize ADC and pins for measuring current and voltage | ||||||
|  |  */ | ||||||
|  | void adc_init(void); | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  * Measure the voltage on the channel for the current.  | ||||||
|  |  * This function is expected to do some filtering. | ||||||
|  |  *  | ||||||
|  |  * @return The offset  | ||||||
|  |  */ | ||||||
|  |  | ||||||
|  | uint16_t measure_voltage(void); | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  * Measure the current on the solar panel. | ||||||
|  |  * This function is expected to do some filtering | ||||||
|  |  *  | ||||||
|  |  * @param offset : the offset as measured by measure_current_offset  | ||||||
|  |  * @return the current in microamperes | ||||||
|  |  */ | ||||||
|  |  | ||||||
|  | uint16_t measure_current(uint16_t offset); | ||||||
|  |  | ||||||
|  |  | ||||||
|  |  | ||||||
|  | #endif /* MEASURE_H */ | ||||||
							
								
								
									
										67
									
								
								solar_panel.X/modbus.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										67
									
								
								solar_panel.X/modbus.c
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,67 @@ | |||||||
|  | #include "modbus.h" | ||||||
|  | #include "crc.h" | ||||||
|  | //#include "uart.h" | ||||||
|  | #include <xc.h> | ||||||
|  | #include <stdint.h> | ||||||
|  | #include <stdio.h> | ||||||
|  |  | ||||||
|  | // Modbus functions | ||||||
|  | #define READ_INPUT_REGISTERS    0x04 | ||||||
|  | #define READ_HOLDING_REGISTERS  0x03 | ||||||
|  | #define WRITE_SINGLE_REGISTER   0x06 | ||||||
|  |  | ||||||
|  | // Modbus data model | ||||||
|  | uint8_t modbusAddress; | ||||||
|  | uint16_t input_registers[2]; | ||||||
|  | uint16_t holding_registers[2]; | ||||||
|  |  | ||||||
|  | // Modbus error codes | ||||||
|  | #define ILLEGAL_FUNCTION		1 | ||||||
|  | #define ILLEGAL_DATA_ADDRESS	2 | ||||||
|  | #define ILLEGAL_DATA_VALUE		3 | ||||||
|  | #define SLAVE_DEVICE_FAILURE	4 | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  * Buffers for serial receive and send operations  | ||||||
|  |  * which are more than one byte long | ||||||
|  |  **/ | ||||||
|  | uint8_t rx_buf[256]; | ||||||
|  | uint8_t tx_buf[256]; | ||||||
|  |  | ||||||
|  | // Current position pointer for storing receive position | ||||||
|  | uint8_t recPtr = 0; | ||||||
|  |  | ||||||
|  | void modbus_timer(void) | ||||||
|  | { | ||||||
|  | 	// TODO -> complete what to do on modbus timer event | ||||||
|  |     | ||||||
|  | } | ||||||
|  |  | ||||||
|  | uint8_t modbus_analyse_and_answer(void) | ||||||
|  | { | ||||||
|  | 	// TODO -> complete the modbus analyse and answer | ||||||
|  |    | ||||||
|  | } | ||||||
|  |  | ||||||
|  | void modbus_char_recvd(uint8_t c) | ||||||
|  | { | ||||||
|  | 	// TODO -> complete modbus char receive  | ||||||
|  | } | ||||||
|  |  | ||||||
|  | void modbus_send(uint8_t length) | ||||||
|  | { | ||||||
|  | 	uint16_t temp16;  | ||||||
|  | 	uint8_t i; | ||||||
|  |  | ||||||
|  | 	// TODO -> complete modbus RCR calculation | ||||||
|  | 	length += 2; // add 2 CRC bytes for total size | ||||||
|  |  | ||||||
|  | 	// For all the bytes to be transmitted | ||||||
|  |   uart_send(tx_buf,length); | ||||||
|  | } | ||||||
|  |  | ||||||
|  | void modbus_init(uint8_t address) | ||||||
|  | { | ||||||
|  | 	modbusAddress = address; | ||||||
|  |   // TODO -> configute timer for modbus usage | ||||||
|  | } | ||||||
							
								
								
									
										62
									
								
								solar_panel.X/modbus.h
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										62
									
								
								solar_panel.X/modbus.h
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,62 @@ | |||||||
|  | /************************************************************************//** | ||||||
|  |  * \file	modbus.h | ||||||
|  |  * \brief	Modbus serial library | ||||||
|  |  ***************************************************************************/ | ||||||
|  |  | ||||||
|  | #ifndef MODBUS_H | ||||||
|  | #define	MODBUS_H | ||||||
|  |  | ||||||
|  | #include <stdint.h> | ||||||
|  |  | ||||||
|  | extern uint8_t modbusAddress; | ||||||
|  | extern uint16_t input_registers[2]; | ||||||
|  | extern uint16_t holding_registers[2]; | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  * Initializes this Modbus library.  | ||||||
|  |  *  | ||||||
|  |  * Initialize pins, timer, serial port and variables. Interrupts  | ||||||
|  |  * MUST be initialized for the  timer and the serial port. | ||||||
|  |  *  | ||||||
|  |  * @param address : the Modbus address of this device | ||||||
|  |  *  | ||||||
|  |  * @see modbus_char_recvd | ||||||
|  |  * @see modbus_timer | ||||||
|  |  * @see interrupts.c | ||||||
|  |  */ | ||||||
|  | void modbus_init(uint8_t address); | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  * Analyses the received frame and answer to server | ||||||
|  |  *  | ||||||
|  |  * @return an error code if frame not valid | ||||||
|  |  */ | ||||||
|  | uint8_t modbus_analyse_and_answer(void); | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  * Send the Modbus frame on tx_buf with CRC added | ||||||
|  |  *  | ||||||
|  |  * @param length : length of the frame without the CRC  | ||||||
|  |  */ | ||||||
|  | void modbus_send(uint8_t length); | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  *   | ||||||
|  |  * This function will be called every time a character has been received on the | ||||||
|  |  * Modbus serial port. It is called from the interrupt hander. | ||||||
|  |  *  | ||||||
|  |  * @param c : the received char | ||||||
|  |  * @see interrupts.c. | ||||||
|  |  */ | ||||||
|  | void modbus_char_recvd(uint8_t c); | ||||||
|  |  | ||||||
|  | /** | ||||||
|  |  * Modbus timer finished. This function is called by the interrupt handler  | ||||||
|  |  * when a MODBUS frame is finished. It must analyse the received packet  | ||||||
|  |  * and reply if required. | ||||||
|  |  *  | ||||||
|  |  * @see interrupts.c | ||||||
|  |  */ | ||||||
|  | void modbus_timer(void); | ||||||
|  |  | ||||||
|  | #endif /* MODBUS_H */ | ||||||
							
								
								
									
										55
									
								
								solar_panel.X/old_main.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										55
									
								
								solar_panel.X/old_main.c
									
									
									
									
									
										Normal file
									
								
							| @@ -0,0 +1,55 @@ | |||||||
|  | /************************************************************************//** | ||||||
|  |  * \file	main.c | ||||||
|  |  * \brief	Program main file for MODBUS controller | ||||||
|  |  ***************************************************************************/ | ||||||
|  |  | ||||||
|  |  | ||||||
|  | #include <xc.h> | ||||||
|  | #include <stdint.h> | ||||||
|  | #include <stdbool.h> | ||||||
|  | #include <stdio.h> | ||||||
|  |  | ||||||
|  | #include "lcd/lcd.h" | ||||||
|  | #include "pwm.h" | ||||||
|  | #include "measure.h" | ||||||
|  | #include "modbus.h" | ||||||
|  | #include "uart.h" | ||||||
|  |  | ||||||
|  | #define _XTAL_FREQ  64000000L | ||||||
|  | /** | ||||||
|  |  * Initialize clock, buttons, leds and interrupts | ||||||
|  |  */ | ||||||
|  | void init_hw() | ||||||
|  | { | ||||||
|  | 	OSCCON3 = 0; // runs at 64MHz | ||||||
|  | 	LCD_Init(LCD_2x16); | ||||||
|  | 	adc_init(); | ||||||
|  | 	modbus_init(0x80); | ||||||
|  | 	pwm_init(); | ||||||
|  |   uart_init(); | ||||||
|  | 	// Interrupts configuration | ||||||
|  | 	PEIE = 1; | ||||||
|  | 	GIE = 1; | ||||||
|  | } | ||||||
|  |  | ||||||
|  | uint8_t tmpStr[30]; | ||||||
|  | uint16_t u; ///< Voltage in milliovolts | ||||||
|  | uint16_t i; ///< Current in microamperes | ||||||
|  | uint16_t p; ///< Power in microwatts | ||||||
|  |  | ||||||
|  | uint16_t offset; | ||||||
|  | uint16_t pwm = 512; | ||||||
|  |  | ||||||
|  | void main(void) | ||||||
|  | { | ||||||
|  | 	init_hw(); | ||||||
|  | 	 | ||||||
|  | 	LCD_2x16_WriteMsg((unsigned char *)"Welcome !       ", 0); // display on line 0 | ||||||
|  | 	LCD_2x16_WriteMsg((unsigned char *)"*-*-*-*-*-*-*-*-", 1); // display on line 1 | ||||||
|  | 			 | ||||||
|  | 	// TODO -> complete measure of current offset | ||||||
|  |  | ||||||
|  | 	while (true) { | ||||||
|  | 	// TODO -> complete the main loop | ||||||
|  | 	} | ||||||
|  | } | ||||||
		Reference in New Issue
	
	Block a user