KB8PMY
/
CubeSatSim
mirror of https://github.com/alanbjohnston/CubeSatSim.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #357 from alanbjohnston/fc-a

Browse Source 
FunCube mode with some telem channels
fc-jy-1
Alan Johnston 11 months ago committed by GitHub
parent 79eab43535 c62859adb9
commit 9128e92298
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
2 changed files with 22 additions and 10 deletions
Show Stats Download Patch File Download Diff File

31
main.c
Unescape View File

@ -743,7 +743,7 @@ int main(int argc, char * argv[]) {
double Yv = eclipse * volts_max[1] * (float) sin((2.0 * 3.14 * time / (46.0 * speed)) + (3.14 / 2.0)) + rnd_float(-0.2, 0.2); double Yv = eclipse * volts_max[1] * (float) sin((2.0 * 3.14 * time / (46.0 * speed)) + (3.14 / 2.0)) + rnd_float(-0.2, 0.2);
double Zv = 2.0 * eclipse * volts_max[2] * (float) sin((2.0 * 3.14 * time / (46.0 * speed)) + 3.14 + angle[2]) + rnd_float(-0.2, 0.2); double Zv = 2.0 * eclipse * volts_max[2] * (float) sin((2.0 * 3.14 * time / (46.0 * speed)) + 3.14 + angle[2]) + rnd_float(-0.2, 0.2);
// printf("Yi: %f Zi: %f %f %f Zv: %f \n", Yi, Zi, amps_max[2], angle[2], Zv); // printf("Yi: %f Zi: %f %f %f Zv: %f \n", Yi, Zi, amps_max[2], angle[2], Zv);
current[map[PLUS_X]] = (Xi >= 0) ? Xi : 0; current[map[PLUS_X]] = (Xi >= 0) ? Xi : 0;
current[map[MINUS_X]] = (Xi >= 0) ? 0 : ((-1.0f) * Xi); current[map[MINUS_X]] = (Xi >= 0) ? 0 : ((-1.0f) * Xi);
@ -759,7 +759,7 @@ int main(int argc, char * argv[]) {
voltage[map[PLUS_Z]] = (Zv >= 1) ? Zv : rnd_float(0.9, 1.1); voltage[map[PLUS_Z]] = (Zv >= 1) ? Zv : rnd_float(0.9, 1.1);
voltage[map[MINUS_Z]] = (Zv <= -1) ? ((-1.0f) * Zv) : rnd_float(0.9, 1.1); voltage[map[MINUS_Z]] = (Zv <= -1) ? ((-1.0f) * Zv) : rnd_float(0.9, 1.1);
// printf("temp: %f Time: %f Eclipse: %d : %f %f | %f %f | %f %f\n",tempS, time, eclipse, voltage[map[PLUS_X]], voltage[map[MINUS_X]], voltage[map[PLUS_Y]], voltage[map[MINUS_Y]], current[map[PLUS_Z]], current[map[MINUS_Z]]); printf("temp: %f Time: %f Eclipse: %d : %f %f | %f %f | %f %f\n",tempS, time, eclipse, voltage[map[PLUS_X]], voltage[map[MINUS_X]], voltage[map[PLUS_Y]], voltage[map[MINUS_Y]], current[map[PLUS_Z]], current[map[MINUS_Z]]);
tempS += (eclipse > 0) ? ((temp_max - tempS) / 50.0f) : ((temp_min - tempS) / 50.0f); tempS += (eclipse > 0) ? ((temp_max - tempS) / 50.0f) : ((temp_min - tempS) / 50.0f);
tempS += +rnd_float(-1.0, 1.0); tempS += +rnd_float(-1.0, 1.0);
@ -772,9 +772,10 @@ int main(int argc, char * argv[]) {
// float charging = current[map[PLUS_X]] + current[map[MINUS_X]] + current[map[PLUS_Y]] + current[map[MINUS_Y]] + current[map[PLUS_Z]] + current[map[MINUS_Z]]; // float charging = current[map[PLUS_X]] + current[map[MINUS_X]] + current[map[PLUS_Y]] + current[map[MINUS_Y]] + current[map[PLUS_Z]] + current[map[MINUS_Z]];
float charging = eclipse * (fabs(amps_max[0] * 0.707) + fabs(amps_max[1] * 0.707) + rnd_float(-4.0, 4.0)); float charging = eclipse * (fabs(amps_max[0] * 0.707) + fabs(amps_max[1] * 0.707) + rnd_float(-4.0, 4.0));
current[map[BAT]] = ((current[map[BAT2]] * voltage[map[BAT2]]) / batt) - charging; // current[map[BAT]] = ((current[map[BAT2]] * voltage[map[BAT2]]) / batt) - charging;
current[map[BAT]] = rnd_float(285, 410) - current[map[PLUS_X]] - current[map[MINUS_X]] - current[map[PLUS_Y]] - current[map[MINUS_Y]] - current[map[PLUS_Z]] - current[map[MINUS_Z]];
// printf("charging: %f bat curr: %f bus curr: %f bat volt: %f bus volt: %f \n",charging, current[map[BAT]], current[map[BAT2]], batt, voltage[map[BAT2]]); printf("charging: %f bat curr: %f bus curr: %f bat volt: %f bus volt: %f \n",charging, current[map[BAT]], current[map[BAT2]], batt, voltage[map[BAT2]]);
batt -= (batt > 3.5) ? current[map[BAT]] / 30000 : current[map[BAT]] / 3000; batt -= (batt > 3.5) ? current[map[BAT]] / 30000 : current[map[BAT]] / 3000;
if (batt < 3.0) { if (batt < 3.0) {
@ -2302,12 +2303,21 @@ void get_tlm_fc() {
// printf("\nSYMPBLOCK = %d\n", SYMPBLOCK); // printf("\nSYMPBLOCK = %d\n", SYMPBLOCK);
memset(source_bytes, 0x00, sizeof(source_bytes)); memset(source_bytes, 0x00, sizeof(source_bytes));
source_bytes[0] = 0b10000010 ; // 10100000 10000001 01000001 10000001 10000001 source_bytes[0] = 0b00000001 ; // 10100000 10000001 01000001 10000001 10000001
source_bytes[1] = 0b10000010 ; source_bytes[1] = 0b10000010 ;
source_bytes[10] = (uint8_t) rnd_float(0,255);
source_bytes[50] = 0xff; // Sequence number // printf("Volt: %f Int: %d \n", voltage[map[BAT]], (unsigned int)(voltage[map[BAT]] * 1000));
source_bytes[51] = 0xff; // printf("Amps: %f Int: %d \n", current[map[BAT]], (unsigned int)(current[map[BAT]] * 1));
source_bytes[52] = 0xff;
source_bytes[9] = 0xff & (((unsigned int)(voltage[map[BAT]] * 1000) >> 8)); // mV
source_bytes[10] = 0xff & ((unsigned int)(voltage[map[BAT]] * 1000));
source_bytes[11] = 0xff & (((unsigned int)(current[map[BAT]] * 1) >> 8)); // mA
source_bytes[12] = 0xff & ((unsigned int)(current[map[BAT]] * 1));
source_bytes[13] = 0xff & (((unsigned long int)reset_count >> 8));
source_bytes[14] = 0xff & ((unsigned long int)reset_count);
source_bytes[50] = 0xff & ((unsigned long int)sequence >> 16); // Sequence number
source_bytes[51] = 0xff & ((unsigned long int)sequence >> 8);
source_bytes[52] = 0xff & (unsigned long int)sequence++;
/**/ /**/
printf("\nsource_bytes\n"); printf("\nsource_bytes\n");
for (int i=0; i<256; i++) for (int i=0; i<256; i++)
@ -2481,7 +2491,8 @@ void get_tlm_fc() {
/* write waveform buffer over socket */ /* write waveform buffer over socket */
int length = (headerLen + syncBits + dataLen) * samples; int length = (((headerLen + syncBits + dataLen) * samples) * 2) + 2; // ctr * 2 + 2 like bpsk due to 2 bytes per sample.
printf("length: %d ctr: %d\n", length, ctr);
if (!error && transmit) { if (!error && transmit) {
// digitalWrite (0, LOW); // digitalWrite (0, LOW);

1
main.h
Unescape View File

@ -104,6 +104,7 @@ FILE * file1;
short int buffer[2336400]; // max size for 10 frames count of BPSK short int buffer[2336400]; // max size for 10 frames count of BPSK
FILE *sopen(const char *program); FILE *sopen(const char *program);
FILE *telem_file; FILE *telem_file;
long int sequence = 131328;
#define S_RATE (48000) // (44100) #define S_RATE (48000) // (44100)

Write Preview
Loading…
Cancel
Save

Powered by TurnKey Linux.