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

Update cw_main.c

Browse Source
pull/1/head
alanbjohnston 7 years ago committed by GitHub
parent 0aaa45dcc2
commit c3a2710ee1
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 28 additions and 89 deletions
Show Stats Download Patch File Download Diff File

107
cw/cw_main.c
Unescape View File

@ -67,7 +67,6 @@ int upper_digit(int number);
int encode_digit(uint8_t *msg, int number); int encode_digit(uint8_t *msg, int number);
void config_cw(); void config_cw();
int encode_tlm(uint8_t *buffer, int channel, int val1, int val2, int val3, int val4, int avail); int encode_tlm(uint8_t *buffer, int channel, int val1, int val2, int val3, int val4, int avail);
int encode_tlm_partial(uint8_t *buffer, int channel, int val1, int val2);
int encode_header(uint8_t *buffer, int avail); int encode_header(uint8_t *buffer, int avail);
int add_dash(uint8_t *msg, int number); int add_dash(uint8_t *msg, int number);
int add_dot(uint8_t *msg, int number); int add_dot(uint8_t *msg, int number);
@ -79,7 +78,7 @@ int main(void)
{ {
uint8_t retVal; uint8_t retVal;
int tlm[7][5]; int tlm[7][5];
int i,j; int i, j;
for (i = 1; i < 7; i++) { for (i = 1; i < 7; i++) {
for (j = 1; j < 5; j++) { for (j = 1; j < 5; j++) {
tlm[i][j] = 0; tlm[i][j] = 0;
@ -123,18 +122,19 @@ int main(void)
} }
config_cw(); config_cw();
// allocate space for buffers // allocate space for the buffer
static uint8_t packet[MAX_MESSAGE_LENGTH + 1]; static uint8_t packet[MAX_MESSAGE_LENGTH + 1];
int channel; // AO-7 telemetry format has 6 channels, 4 sub channels in each int channel; // AO-7 telemetry format has 6 channels, 4 sub channels in each
int msg_length; int msg_length;
while(1) { // loop forever
for (channel = 0; channel < 7; channel++) { for (channel = 0; channel < 7; channel++) {
get_tlm(tlm); get_tlm(tlm);
// printf("TLM Received 1a: %d 2b: %d\n", tlm[1][1], tlm[2][2]); // printf("TLM Received 1a: %d 2b: %d\n", tlm[1][1], tlm[2][2]);
// send_afsk(tlm); send_afsk(tlm);
config_cw(); config_cw();
if (channel == 0) { if (channel == 0) {
@ -142,13 +142,6 @@ int main(void)
msg_length = encode_header(&packet[0], MAX_MESSAGE_LENGTH + 1); msg_length = encode_header(&packet[0], MAX_MESSAGE_LENGTH + 1);
printf("\nINFO: Sending TLM header\n"); printf("\nINFO: Sending TLM header\n");
/**/
retVal = transmit_packet(&remoteaddr_tx, packet, (uint16_t)(msg_length)); // send telemetry
if (retVal != AXRADIO_ERR_NOERROR) {
fprintf(stderr, "ERROR: Unable to transmit a packet\n");
exit(EXIT_FAILURE);
}
/**/
} else { } else {
@ -157,51 +150,25 @@ int main(void)
// int tlm_3a = 0, tlm_1b = 0; // int tlm_3a = 0, tlm_1b = 0;
/**/ msg_length = encode_tlm(&packet[0], channel, // add a channel with dummy data to buffer msg_length = encode_tlm(&packet[0], channel, // add a channel with dummy data to buffer
// tlm_3a, tlm_1b, channel+2, channel+3, // tlm_3a, tlm_1b, channel+2, channel+3,
tlm[channel][1], tlm[channel][2], tlm[channel][3], tlm[channel][4], tlm[channel][1], tlm[channel][2], tlm[channel][3], tlm[channel][4],
(MAX_MESSAGE_LENGTH + 1)); (MAX_MESSAGE_LENGTH + 1));
/**/
// msg_length = encode_tlm_partial(&packet[0], channel, tlm[channel][1], tlm[channel][2]);
printf("\nINFO: Sending TLM channel %d \n", channel); printf("\nINFO: Sending TLM channel %d \n", channel);
/**/
retVal = transmit_packet(&remoteaddr_tx, packet, (uint16_t)(msg_length)); // send telemetry
if (retVal != AXRADIO_ERR_NOERROR) {
fprintf(stderr, "ERROR: Unable to transmit a packet\n");
exit(EXIT_FAILURE);
} }
/**/ // printf("DEBUG: msg_length = %d\n", msg_length);
/* get_tlm(tlm);
send_afsk(tlm);
config_cw();
msg_length = encode_tlm_partial(&packet[0], channel, tlm[channel][3], tlm[channel][4]);
printf("\nINFO: Sending TLM channel %d \n", channel);
retVal = transmit_packet(&remoteaddr_tx, packet, (uint16_t)(msg_length)); // send telemetry retVal = transmit_packet(&remoteaddr_tx, packet, (uint16_t)(msg_length)); // send telemetry
if (retVal != AXRADIO_ERR_NOERROR) { if (retVal != AXRADIO_ERR_NOERROR) {
fprintf(stderr, "ERROR: Unable to transmit a packet\n"); fprintf(stderr, "ERROR: Unable to transmit a packet\n");
exit(EXIT_FAILURE); exit(EXIT_FAILURE);
} }
*/
}
}
while (1) { // loop forever
get_tlm(tlm);
send_afsk(tlm);
sleep (4);
}
// sleep(1); // sleep(1);
// usleep(200000); usleep(200000);
}
}
} }
// Encodes telemetry header (channel 0) into buffer // Encodes telemetry header (channel 0) into buffer
// //
@ -290,33 +257,6 @@ int encode_tlm(uint8_t *buffer, int channel, int val1, int val2, int val3, int v
} }
return count; return count;
} }
// Encodes one channel of telemetry into buffer
//
int encode_tlm_partial(uint8_t *buffer, int channel, int val1, int val2) {
int count = 0;
count += add_space(&buffer[count]);
count += add_space(&buffer[count]);
count += add_space(&buffer[count]);
count += add_space(&buffer[count]);
count += encode_digit(&buffer[count], channel); // for channel 1, encodes 1aa
count += encode_digit(&buffer[count], upper_digit(val1));
count += encode_digit(&buffer[count], lower_digit(val1));
count += add_space(&buffer[count]);
count += encode_digit(&buffer[count], channel); // for channel 1, encodes 1bb
count += encode_digit(&buffer[count], upper_digit(val2));
count += encode_digit(&buffer[count], lower_digit(val2));
count += add_space(&buffer[count]);
return count;
}
// Encodes a single digit of telemetry into buffer // Encodes a single digit of telemetry into buffer
// //
int encode_digit(uint8_t *buffer, int digit) { int encode_digit(uint8_t *buffer, int digit) {
@ -512,16 +452,15 @@ int add_dot(uint8_t *msg, int number) {
return counter; return counter;
} }
int get_tlm(int tlm[][5]) { int get_tlm(int tlm[][5]) {
static char cmdbuffer[1000];
static char mopower[64][14];
static char ina219[16][20]; // voltage, currents, and power from the INA219 current sensors x4a, x40, x41, x44, and x45.
// Read MoPower UPS data // Read MoPower UPS data
FILE* file = popen("mpcmd show data 2>&1", "r"); FILE* file = popen("mpcmd show data 2>&1", "r");
char cmdbuffer[1000];
fgets(cmdbuffer, 1000, file); fgets(cmdbuffer, 1000, file);
pclose(file); pclose(file);
// printf("buffer is :%s\n", cmdbuffer); // printf("buffer is :%s\n", cmdbuffer);
char mopower[64][14];
char * data2; char * data2;
int i = 0; int i = 0;
data2 = strtok (cmdbuffer," "); data2 = strtok (cmdbuffer," ");
@ -583,30 +522,31 @@ int get_tlm(int tlm[][5]) {
pclose(file); pclose(file);
// printf("Current buffer is:%s\n", cmdbuffer); // printf("Current buffer is:%s\n", cmdbuffer);
char ina219[16][20]; // voltage, currents, and power from the INA219 current sensors x4a, x40, x41, x44, and x45.
i = 0; i = 0;
data2 = strtok (cmdbuffer," "); data2 = strtok (cmdbuffer," ");
while (data2 != NULL) { while (data2 != NULL) {
strcpy(ina219[i], data2); strcpy(ina219[i], data2);
// printf ("ina219[%d]=%s\n",i,ina219[i]); printf ("ina219[%d]=%s\n",i,ina219[i]);
data2 = strtok (NULL, " "); data2 = strtok (NULL, " ");
i++; i++;
} }
// printf("1B: ina219[%d]: %s val: %f \n", SENSOR_40 + CURRENT, ina219[SENSOR_40 + CURRENT], strtof(ina219[SENSOR_40 + CURRENT], NULL)); printf("1B: ina219[%d]: %s val: %f \n", SENSOR_40 + CURRENT, ina219[SENSOR_40 + CURRENT], strtof(ina219[SENSOR_40 + CURRENT], NULL));
tlm[1][B] = (int) (99.5 - strtof(ina219[SENSOR_40 + CURRENT], NULL)/5.0); // +X current [4] tlm[1][B] = (int) (99.5 - strtof(ina219[SENSOR_40 + CURRENT], NULL)/10); // +X current [4]
tlm[1][D] = (int) (99.5 - strtof(ina219[SENSOR_41 + CURRENT], NULL)/5.0); // +Y current [7] tlm[1][D] = (int) (99.5 - strtof(ina219[SENSOR_41 + CURRENT], NULL)/10); // +Y current [7]
tlm[1][C] = (int) (99.5 - strtof(ina219[SENSOR_44 + CURRENT], NULL)/5.0); // +Z current [10] (actually -X current, AO-7 didn't have a Z solar panel?) tlm[1][C] = (int) (99.5 - strtof(ina219[SENSOR_44 + CURRENT], NULL)/10); // +Z current [10] (actually -X current, AO-7 didn't have a Z solar panel?)
// int tlm_3b = (int)(strtof(ina219[0], NULL) * 10.0); // int tlm_3b = (int)(strtof(ina219[0], NULL) * 10.0);
// int tlm_2d = (int)(50.0 + strtof(ina219[SENSOR_4A + VOLTAGE], NULL)/40.0); // int tlm_2d = (int)(50.0 + strtof(ina219[SENSOR_4A + VOLTAGE], NULL)/40.0);
tlm[3][B] = (int)(strtof(ina219[SENSOR_4A + VOLTAGE], NULL) * 5.0); // 5V supply to Pi tlm[3][B] = (int)(strtof(ina219[SENSOR_4A + VOLTAGE], NULL) * 10.0); // 5V supply to Pi
tlm[2][D] = (int)(50.5 + strtof(ina219[SENSOR_45 + CURRENT], NULL)/10.0); // NiMH Battery current tlm[2][D] = (int)(50.5 + strtof(ina219[SENSOR_45 + CURRENT], NULL)/10.0); // NiMH Battery current
// printf(" 2D: %d 3B: %d\n", tlm_2d, tlm_3b); // printf(" 2D: %d 3B: %d\n", tlm_2d, tlm_3b);
// printf("1A: ina219[%d]: %s val: %f \n", SENSOR_4A + CURRENT, ina219[SENSOR_4A + CURRENT], strtof(ina219[SENSOR_4A + CURRENT], NULL)); printf("1A: ina219[%d]: %s val: %f \n", SENSOR_4A + CURRENT, ina219[SENSOR_4A + CURRENT], strtof(ina219[SENSOR_4A + CURRENT], NULL));
tlm[1][A] = (int)(strtof(ina219[SENSOR_4A + CURRENT], NULL) / 7.5 + 0.5); // Current of 5V supply to Pi tlm[1][A] = (int)(strtof(ina219[SENSOR_4A + CURRENT], NULL) / 15 + 0.5); // Current of 5V supply to Pi
int tempValue = wiringPiI2CReadReg16(tempSensor, 0); int tempValue = wiringPiI2CReadReg16(tempSensor, 0);
// printf("Read: %x\n", tempValue); // printf("Read: %x\n", tempValue);
@ -615,19 +555,19 @@ int get_tlm(int tlm[][5]) {
uint8_t lower = (uint8_t) (tempValue & 0xff); uint8_t lower = (uint8_t) (tempValue & 0xff);
float temp = (float)lower + ((float)upper / 0x100); float temp = (float)lower + ((float)upper / 0x100);
// printf("upper: %x lower: %x temp: %f\n", upper, lower, temp); printf("upper: %x lower: %x temp: %f\n", upper, lower, temp);
// int tlm_4a = (int)((95.8 - temp)/1.48 + 0.5); // int tlm_4a = (int)((95.8 - temp)/1.48 + 0.5);
tlm[4][A] = (int)((95.8 - temp)/1.48 + 0.5); tlm[4][A] = (int)((95.8 - temp)/1.48 + 0.5);
// printf(" 4A: %d \n", tlm_4a); // printf(" 4A: %d \n", tlm_4a);
tlm[5][A] = (int)((95.8 - (atoi(mopower[UCTEMP]) - 30))/1.48 + 0.5); tlm[5][A] = (int)((95.8 - (atoi(mopower[UCTEMP]) - 30))/1.48 + 0.5);
// printf(" 5A: %d \n", tlm[5][A]); printf(" 5A: %d \n", tlm[5][A]);
// int tlm_6d = 49 + rand() % 3; // int tlm_6d = 49 + rand() % 3;
tlm[6][D] = 49 + rand() % 3; tlm[6][D] = 49 + rand() % 3;
/*
int k, j; int k, j;
for (k = 1; k < 7; k++) { for (k = 1; k < 7; k++) {
for (j = 1; j < 5; j++) { for (j = 1; j < 5; j++) {
@ -635,6 +575,5 @@ int get_tlm(int tlm[][5]) {
} }
printf("\n"); printf("\n");
} }
*/
return 0; return 0;
} }

Write Preview
Loading…
Cancel
Save

Powered by TurnKey Linux.