What is Orbicraft for?
How to work with it
Orbicraft Subsystems
Arduino-Based payload
Lessons
Laboratory equipment
Feedback
News
What is Orbicraft for?
How to work with it
Orbicraft Subsystems
Arduino-Based payload
Lessons
Laboratory equipment
Feedback
News
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
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.
def control(): # Program’s main function sun_result = [0,0,0] # Initialize sun_result num = 1 print "Enable sun sensor №", num sun_sensor_turn_on(num) sleep(1) print "Get RAW data from sun sensor" for i in range(10): sun_result = sun_sensor_request_raw(num) if not sun_result[0]: # if the sensor has not returned error message, print "state:", sun_result[0], "raw =", sun_result[1], \ sun_result[2] elif sun_result[0] == 1: print "Fail because of access error, check the connection" elif sun_result[0] == 2: print "Fail because of interface error, check your code" sleep(1) print "Disable sun sensor №", num sun_sensor_turn_off(num)
С code.
#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.
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.
import time import math #!/usr/bin/env python # -*- coding: utf-8 -*- # Differential feedback coefficient. kd = 200.0 # Algorithm working time step, s time_step = 0.05 # Satellite’s target angular velocity, deg/s. # For stabilization mode it is 0.0. omega_goal = 0.0 # Maximum allowed flywheel speed, rev/min mtr_max_speed = 5000 # Flywheel number mtr_num = 1 # Angular velocity sensors’ number hyr_num = 1 # Magnetometer number mag_num = 1 # Measuring result’s number i = 1 # Current turning angle alpha = 0.0 # The function will switch on all apparatuses # that will be used in the main program. def initialize_all(): print "Enable angular velocity sensor №", hyr_num hyro_turn_on(hyr_num) sleep(1) print "Enable magnetometer", mag_num magnetometer_turn_on(mag_num) sleep(1) # Wait 1 second for switching on print "Enable Sun sensors 1-4" sun_sensor_turn_on(1) sun_sensor_turn_on(2) sun_sensor_turn_on(3) sun_sensor_turn_on(4) sleep(1) print "Enable motor №", mtr_num motor_turn_on(mtr_num) sleep(1) # The function will switch off all sensors, # that will be used in the main program. def switch_off_all(): print "Finishing..." 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) sleep(1) motor_turn_off(mtr_num) print "Finish program" def mag_calibrated(magx,magy,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 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) return magx_cal, magy_cal, magz_cal # 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 def motor_new_speed_PD(mtr_speed, omega, omega_goal): mtr_new_speed = int(mtr_speed + kd*(omega-omega_goal) ) if mtr_new_speed > mtr_max_speed: mtr_new_speed = mtr_max_speed elif mtr_new_speed < -mtr_max_speed: mtr_new_speed = -mtr_max_speed return mtr_new_speed # Program’s main function that will call other functions. def control(): omega_goal = 0 # omega_goal - target satellite’s angular speed, deg/s initialize_all() # Initialize flywheel’s status mtr_state = 0 # Initialize angular velocity sensor’s status hyro_state = 0 sun_sensor_num = 0 # Initialize the variable for the solar sensor’s number sun_result_1 = [0,0,0] # Initialize sun_result_1 sun_result_2 = [0,0,0] # Initialize sun_result_2 sun_result_3 = [0,0,0] # Initialize sun_result_3 sun_result_4 = [0,0,0] # Initialize sun_result_4 mag_alpha = 0 output_data_all = [0, 0, 0, 0, 0, 0, 0, 0, 0] output_data = [0, 0, 0, 0, 0, 0, 0, 0, 0] # Measuring result’s number i = 0 # Put into memory rotation start time time_start = time.time() # Put into memory one-second interval start time time_interval = time.time() # solar sensors data output interval in seconds time_output = 0.1 while True: # angular velocity sensor and flywheel data request hyro_state, gx_raw, gy_raw, gz_raw = hyro_request_raw(hyr_num) mtr_state, mtr_speed = motor_request_speed(mtr_num) mag_state, magx_raw, magy_raw, magz_raw = magnetometer_request_raw(mag_num) # 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) if not hyro_state: 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 elif hyro_state == 1: print "Fail because of access error, check the connection" elif hyro_state == 2: print "Fail because of interface error, check your code" # Processing the readings of flywheel and setting the target angular velocity. if not mtr_state: # if magnetometer returned error code 0 (no error) # 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) time.sleep(time_step) time_current = time.time() - time_start if not mag_state: # if magnetometer returned error code 0 (no error) magx_cal, magy_cal, magz_cal = mag_calibrated(magx_raw,magy_raw,magz_raw) magy_cal = - magy_cal # 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 = math.atan2(magy_cal, magx_cal)/math.pi*180 if (time.time() - time_interval) > time_output: # Put into memory next one-second interval starting time time_interval = time.time() sun_result_1 = sun_sensor_request_raw(1) sun_result_2 = sun_sensor_request_raw(2) sun_result_3 = sun_sensor_request_raw(3) sun_result_4 = sun_sensor_request_raw(4) #print sun_result_1, sun_result_2, sun_result_3, sun_result_4, mag_alpha, time_current 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] output_data_all += output_data if i > 100: # Start rotation upon 5 seconds delay from the moment of launching omega_goal = 6.0 # omega_goal – satellite’s target angular velocity, deg/s if time_current > 90: break i += 1 switch_off_all() print "time_end = " , time.time() - time_start for i in range(0, 5000, 10): print output_data_all[i-1], 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]
С code.
#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.