User Tools

Translations of this page:

Site Tools


en:lesson8

Lesson 08. Getting acquainted with the solar sensors

Getting acquainted with smartphone’s light sensor

Download on smartphone the Andro sensor (or similar) application displaying the information from smartphone’s integrated sensors. Start the applecation, find the light sensor which is called LIGHT.

The illumination is measured in lux; one lux means the illumination of the 1 m² surface at 1 lumen light stream emission falling to this surface. Correspondingly, it is true that: 1 lux = 1 lumen/m2.

One lumen means the light stream that is emitted by point source with candlepower of one candela to the solid angle of one steradian.

The full light stream created by point source with candlepower of one candela is 4π lumen.

Candela is candlepower with energy of 1/683 W/steradian.

Candlepower of one paraffin candle is one candela approximately.

The requirements for the illumination of the work places equopped with PC according to SanPiN 2.2.2/2.4.1340-03:

Desk illumination: 300-500 lux

PC display illumination: lower than 300 lux

Solar Sensors Functionality Test

Connect HOC with Power System and four solar sensors.

Download to the HOC the program that will display the readings from solar sensors.

Python code.

sun_test.py

С code.

sun_test.c
#include <stdio.h>
#include <stdint.h>
#include "libschsat.h"
#define LSS_OK 0 
#define LSS_ERROR 1 
#define LSS_BREAK 2
 
int control(){ // Program’s main function
	uint16_t sun_result[] = {0, 0, 0}; // Initialize sun_result
	uint16_t num = 1; // Solar Sensor’s number 
	printf("Enable sun sensor №%d\n", num);
	sun_sensor_turn_on(num); // Switch on sun sensor	
	Sleep(1); // Wait 1 second for switching on
	printf("Get RAW data from sun sensor №%d\n", num);
	int i;
	for (i = 0; i < 10; i++) //Read the readings 10 times 
	{
		sun_result[0] = sun_sensor_request_raw(num,& sun_result[1],& sun_result[2]);
		if (!sun_result[0]){ // if the sensor has not returned error message
			printf("state: %d raw = %d, %d\n", i, sun_result[1], sun_result[2]);
			}
 
		else if (sun_result[0] == 1) { //if the sensor has returned error message 1
			printf("Fail because of access error, check the connection\n");
			}
		else if (sun_result[0] == 2) { //if the sensor has returned error message 2
			printf("Fail because of interface error, check you code\n");
			}
		Sleep(1); //Readings are read one per second 
 
		}
	printf("Disable sun sensor №%d\n", num);
	sun_sensor_turn_off(num); //Switching sun sensor off 
	return 0;
}

Start the program; at room lighting sensors’ values will be in range from 70 to 300. Direct the light from solar imitator to the sensors – the values will be changed from 70 to 20000.

Values’ collection for solar sensors calibration

Attach to the OrbiCraft top board angular velocity sensor and magnetometer, also attach 4 solar sensors to 4 Orbicraft’s side boards. The solar sensors must be attached in inverted position - that is for prevention of sensors windows’ overlapping by the flat cables.

Download to HOC the program listed below.

Python code.

sun_raw.py

С code.

sun_raw.c
#include <stdio.h>
#include <stdint.h>
#include "libschsat.h"
#define LSS_OK 0 
#define LSS_ERROR 1 
#define LSS_BREAK 2
#include <math.h> 
#include <time.h>
 
//Differential feedback coefficient.
const float kd = 200.0;
 
// Algorithm working time step, s
const float time_step = 0.1;
 
// Satellite’s target angular velocity, deg/s. For stabilization mode it is 0.0
const float omega_goal = 0.0;
// Maximum allowed flywheel speed, rev/min
const int mtr_max_speed = 5000;
const uint16_t mtr_num = 1;			// Flywheel number
const uint16_t hyr_num = 1; 		        // Angular velocity sensors’ number
const uint16_t mag_num = 1;			// Magnetometer number
// Measuring result’s number
int i = 1;
// Current turning angle
const float alpha = 0.0;
 
void initialize_all(void){/* // The function will switch on all apparatuses that will be used in the main program.
	printf("Enable angular velocity sensor №%d\n", hyr_num); 
	hyro_turn_on(hyr_num);
	Sleep(1);
	printf("Enable magnetometer %d\n", mag_num);
	magnetometer_turn_on(mag_num);
	Sleep(1); // Wait 1 second for switching on 
	printf("Enable Sun sensors 1-4\n");
	sun_sensor_turn_on(1);
	sun_sensor_turn_on(2);
	sun_sensor_turn_on(3);
	sun_sensor_turn_on(4);
	Sleep(1);
	printf("Enable motor №%d\n", mtr_num); 
	motor_turn_on(mtr_num);
	Sleep(1);
}
 
void switch_off_all(void){ // The function will switch off all apparatuses, that will be used in the main program.
	printf("Finishing...");
	int16_t new_speed = 0;
	hyro_turn_off(hyr_num);
	magnetometer_turn_off(mag_num);
	sun_sensor_turn_off(1);
	sun_sensor_turn_off(2);
	sun_sensor_turn_off(3);
	sun_sensor_turn_off(4);
	motor_set_speed(mtr_num, 0, &new_speed);
	Sleep(1);
	motor_turn_off(mtr_num);
	printf("\nFinish program\n");
}
 
int mag_calibrated(int16_t *magx, int16_t *magy, int16_t *magz ){
	/* instead of these 3 lines of code with calibration factors 
there must be the lines with calibration factors of your magnetometer */
	//magx_cal = 1.04*magx - 0.26*magy + 0.05*magz - 68.76		// it is the 1st line that must be changed with results of your magnetometer calibration 
	//magy_cal = 0.24*magx + 1.04*magy + 0.29*magz + 256.92	// it is the 2nd line that must be changed with results of your magnetometer calibration а
	//magz_cal = -0.09*magx - 0.19*magy + 0.77*magz + 159.41	// it is the 3rd  line that must be changed with results of your magnetometer calibration
	float magx_cal;
	float magy_cal;
	float magz_cal;
	magx_cal = 1.06*(*magx + -7.49) + -0.01*(*magy + -23.59) + 0.07*(*magz + -108.24);
	magy_cal = -0.01*(*magx + -7.49) + 1.11*(*magy + -23.59) + 0.09*(*magz + -108.24);
	magz_cal = 0.07*(*magx + -7.49) + 0.09*(*magy + -23.59) + 1.00*(*magz + -108.24);
	*magx = magx_cal;
	*magy = magy_cal;
	*magz = magz_cal;
	return 0;
}
 
int motor_new_speed_PD(int mtr_speed, float omega, int16_t omega_goal){	
/* 
Functions that defines flywheel’s new speed.
Flywheel’s new speed will be the sum of 
flywheel’s current speed and speed increment.
Speed increment is proportioned by angle error
and angular velocity error.
mtr_speed - flywheel’s current angular speed, rev/min
omega – satellite’s current angular speed, deg/s
omega_goal - target satellite’s angular speed, deg/s
mtr_new_speed - target flywheel’s angular speed, rev/min
*/
	int16_t mtr_new_speed;
	mtr_new_speed = (int)(mtr_speed + kd * (omega - omega_goal));	
	if (mtr_new_speed > mtr_max_speed)
	{
		mtr_new_speed = mtr_max_speed;
	}
	else if (mtr_new_speed < -mtr_max_speed)
	{
		mtr_new_speed = -mtr_max_speed;
	}
	return mtr_new_speed;
}
 
int control(){// Program’s main function that will call other functions.
	int16_t omega;
	int omega_goal = 0;		// omega_goal - target satellite’s angular speed, deg/s
	initialize_all();		
	int mtr_state = 0;		// Initialize flywheel’s status	
	int hyro_state = 0;		// Initialize angular velocity sensor’s status
	int mag_state = 0; 		// Initialize magnetometer
	int16_t mtr_speed;
	int16_t mtr_new_speed;
	//angular velocity sensor’s data
	int16_t gx_raw;
	int16_t gy_raw;
	int16_t gz_raw;
	int16_t *hyrox_raw=&gx_raw;
	int16_t *hyroy_raw= &gy_raw;
	int16_t *hyroz_raw = &gz_raw;
	//magnetometer data
	int16_t mgx_cal=0;
	int16_t mgy_cal=0;
	int16_t mgz_cal=0;
	int16_t *magx_raw = &mgx_cal;
	int16_t *magy_raw = &mgy_cal;
	int16_t *magz_raw = &mgz_cal;
 
	float gx_degs;
	float gy_degs;
	float gz_degs;
	uint16_t sun_result_1[] = {0,0,0}; // Initialize sun_result_1
	uint16_t sun_result_2[] = {0,0,0}; // Initialize sun_result_2
	uint16_t sun_result_3[] = {0,0,0}; // Initialize sun_result_3
	uint16_t sun_result_4[] = {0,0,0}; // Initialize sun_result_4
	int mag_alpha = 0;
	const int sizeOD = 10;
    int sizeODA = 0;
    int tempSODA;
//	double* output_data = (double*)calloc(sizeOD, sizeof(double));
    double* output_data_all = (double*)calloc(sizeODA, sizeof(double));
 
	// Measuring result’s number
	int i = 0;
	// Put into memory rotation start time 
	long int time_start = time(NULL);
	// Put into memory one-second interval start time 
	long int time_interval = time(NULL);
	// solar sensors data output interval in seconds 
	int time_output = 0.1;
	int j;
	char a=1;
 
	while (a==1){
		// angular velocity sensor and flywheel data request
		hyro_state = hyro_request_raw(hyr_num,hyrox_raw,hyroy_raw,hyroz_raw); 
		mtr_state = motor_request_speed(mtr_num, &mtr_speed);
		mag_state = magnetometer_request_raw(mag_num, magx_raw, magy_raw, magz_raw);
 
 
		if (!hyro_state){
			 /*Processing the readings of angular velocity sensor,
		 calculation of satellite angular velocity upon angular velocity sensor’s readings.
		 If angular velocity sensor’s error code is 0 (no error) */
			gx_degs = gx_raw * 0.00875; 
			gy_degs = gy_raw * 0.00875;
			gz_degs = gz_raw * 0.00875;
			/* if angular velocity sensor arranged via z-axis up, then satellite’s angular velocity
			 matches to sensors’ readings of z-axis, otherwise 
			 it is required to reverse the sign: omega = - gz_degs */
			omega = gz_degs;
//			printf("gx_degs=%f, gy_degs=%f, gz_degs=%f\n", gx_degs, gy_degs, gz_degs);//ну так на всякий 
		}
		else if (hyro_state == 1){
			printf("Fail because of access error, check the connection\n");
		}
		else if (hyro_state == 2) {
			printf("Fail because of interface error, check your code\n");
		}
 
 
		//Processing the readings of flywheel and setting the target angular velocity.	
		if (!mtr_state)	{// if error code 0 (no error)
			int16_t mtr_speed=0;
			motor_request_speed(mtr_num, &mtr_speed);
//			printf("Motor_speed: %d\n", mtr_speed);	
			// set flywheel’s new speed 
			mtr_new_speed = motor_new_speed_PD(mtr_speed,omega,omega_goal);
			motor_set_speed(mtr_num, mtr_new_speed, &omega);
		}
 
		Sleep(time_step);
		long int time_current = time(NULL) - time_start;
 
		if (!mag_state){
			mag_calibrated(magx_raw,magy_raw,magz_raw);
			*magy_raw = - *magy_raw; /*transition from the left coordinate system which is plotted on the magnetometer, to the right coordinate system to position the positive angle direction counter clock-wise*/			
			mag_alpha = atan2(mgy_cal, mgx_cal)/M_PI*180;
		}
 
		if ((time(NULL) - time_interval) > time_output){
			// Put into memory next one-second interval starting time 
			time_interval = time(NULL);
			sun_result_1[0] = sun_sensor_request_raw(1, &sun_result_1[1],&sun_result_1[2]);
			sun_result_2[0] = sun_sensor_request_raw(2,&sun_result_2[1],&sun_result_2[2]);
			sun_result_3[0] = sun_sensor_request_raw(3,&sun_result_3[1],&sun_result_3[2]);
			sun_result_4[0] = sun_sensor_request_raw(4,&sun_result_4[1],&sun_result_4[2]);
 
			int output_data[] = {time_current, sun_result_1[1], sun_result_1[2], sun_result_2[1], sun_result_2[2], sun_result_3[1], sun_result_3[2], sun_result_4[1], sun_result_4[2], mag_alpha};
			tempSODA = sizeODA;
			sizeODA += sizeOD;
			output_data_all = (double*)realloc(output_data_all, sizeODA*sizeof(double));
			for (j=tempSODA; j<sizeODA; j++) {
				output_data_all[j] = output_data[j-sizeODA+1];
			}
		}		
		if (i > 100){  // Start rotation upon 5 seconds delay from the moment of launching
			omega_goal = 6.0;  // omega_goal - omega_goal – satellite’s target angular velocity, deg/s
		}
 
		if 	(time_current > 90){
			break;	
		}
		i += 1;	
	} 
 
	switch_off_all();
 
	printf("time_end = %ld" , time(NULL) - time_start);
 
	for (i = 0; i < 5000; i = i + 10){
		printf("%f, %f, %f, %f, %f, %f, %f, %f, %f, %f\n",output_data_all[i], output_data_all[i+1], output_data_all[i+2], output_data_all[i+3], output_data_all[i+4], output_data_all[i+5], output_data_all[i+6], output_data_all[i+7], output_data_all[i+8], output_data_all[i+9]);
	}
	printf ("Ok\n");
	return 0;
}

Based on the program run’s results there will be displayed 500 data lines in such form:

onmessage0.132400989532 74 117 27 25 156 214 156 61 -34.6566118491 
onmessage0.281419992447 74 116 27 25 156 215 156 61 -34.555539497 
onmessage0.438189029694 74 116 27 25 156 214 156 61 -33.6820711721 
onmessage0.585952043533 74 116 27 25 156 215 156 61 -34.6566118491 
onmessage0.733724832535 74 116 27 25 156 214 156 61 -33.6705914701 
onmessage0.88149189949  74 117 27 25 156 214 156 61 -33.7733709383 
onmessage1.02926301956  74 117 27 25 156 214 156 61 -33.6745869595 
onmessage1.1782848835   74 117 27 25 156 214 156 61 -33.4062495287 
onmessage1.32730197906  74 117 27 25 156 214 156 61 -33.2488503276 
onmessage1.47507381439  74 117 27 25 156 214 156 61 -33.8923918648 

when the first value is the time elapsed from measurement start, next two values are the data from the first solar sensor, next two values are the data from the second solar sensor, next two values are the data from the third solar sensor and the next two – from the fourth sensor. The tenth value is magnetometer readings (OrbiCraft’s turning angle as related to direction to the magnetic pole). To analyze the collected data they must be copied from browser (select the data with Ctrl-A and copy with Ctrl-С) and saved in the new text document created with Notepad++ (insert with Ctrl-V). Than the data must be cleared from service information that is present at the file start and end. The frequent service word onmessage must be deleted with Notepad++ replace function. Press Ctrl-H, enter to the “Find” field “onmessage”, leave the “Replace” field blank and press “Replace all” or “Replace in all open documents”.

Save the clear document in .txt form file. Now it may be analyzed with Excel.

en/lesson8.txt · Last modified: 2020/03/25 16:28 (external edit)