Sam Clarke / Mbed 2 deprecated Plan13

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   GPS mbed

main.cpp@4:e16c4e5b9dbc, 2014-01-20 (annotated)

Committer:
SamClarke
Date:
Mon Jan 20 10:24:09 2014 +0000
Revision:
4:e16c4e5b9dbc
Parent:
3:e7cebcde3db7
Child:
5:8af1b8452986
Add beerware lic

Who changed what in which revision?

UserRevisionLine numberNew contents of line
SamClarke 4:e16c4e5b9dbc 1 // Note!!!! This software is under a beerware license,
SamClarke 4:e16c4e5b9dbc 2 // please send a beer to clarke.sam1@gmail.com
SamClarke 4:e16c4e5b9dbc 3 // via paypal if you find this code useful.
SamClarke 0:78d4704bd4e7 4
SamClarke 0:78d4704bd4e7 5
SamClarke 0:78d4704bd4e7 6 #include "Plan13.h"
SamClarke 0:78d4704bd4e7 7 #include "GPS.h"
SamClarke 0:78d4704bd4e7 8 #include "mbed.h"
SamClarke 0:78d4704bd4e7 9
SamClarke 0:78d4704bd4e7 10 #define ONEPPM 1.0e-6
SamClarke 0:78d4704bd4e7 11 #define ONEPPTM 1.0e-7
SamClarke 0:78d4704bd4e7 12
SamClarke 2:735bdcc06386 13 char *astra2f_tle =
SamClarke 2:735bdcc06386 14 "ASTRA 2F"
SamClarke 2:735bdcc06386 15 "1 38778U 12051A 14010.00000000 .00000143 00000-0 00000+0 0 2381"
SamClarke 2:735bdcc06386 16 "2 38778 000.0670 267.2510 0004011 341.2500 249.1500 01.00276604 4755";
SamClarke 2:735bdcc06386 17
SamClarke 2:735bdcc06386 18 void target_tle(int year, char *tle, struct Target *t);
SamClarke 2:735bdcc06386 19
SamClarke 2:735bdcc06386 20 void calculate(Plan13& p, GPS& g, struct Target *t);
SamClarke 2:735bdcc06386 21
SamClarke 2:735bdcc06386 22 void target_data(int yr, float epoch, float inc, float raan,
SamClarke 2:735bdcc06386 23 float ecc, float arg, float anom, float mmotion,
SamClarke 2:735bdcc06386 24 float tmotion, float epoch_orbit, struct Target *t);
SamClarke 1:ab43ae956815 25 struct Target{
SamClarke 0:78d4704bd4e7 26 int YEAR;
SamClarke 0:78d4704bd4e7 27 float EPOCH;
SamClarke 0:78d4704bd4e7 28 float INCLINATION;
SamClarke 0:78d4704bd4e7 29 float RAAN;
SamClarke 0:78d4704bd4e7 30 float ECCENTRICITY;
SamClarke 0:78d4704bd4e7 31 float ARGUMENT_PEDIGREE;
SamClarke 0:78d4704bd4e7 32 float MEAN_ANOMALY;
SamClarke 0:78d4704bd4e7 33 float MEAN_MOTION;
SamClarke 0:78d4704bd4e7 34 float TIME_MOTION_D;
SamClarke 0:78d4704bd4e7 35 float EPOCH_ORBIT;
SamClarke 0:78d4704bd4e7 36 float azimuth;
SamClarke 0:78d4704bd4e7 37 float elevation;
SamClarke 0:78d4704bd4e7 38 };
SamClarke 0:78d4704bd4e7 39
SamClarke 2:735bdcc06386 40 Plan13 p;
SamClarke 2:735bdcc06386 41 GPS gps(p9,p10);
SamClarke 0:78d4704bd4e7 42 Serial pc(USBTX, USBRX);
SamClarke 0:78d4704bd4e7 43
SamClarke 0:78d4704bd4e7 44 int main()
SamClarke 0:78d4704bd4e7 45 {
SamClarke 2:735bdcc06386 46 struct Target ASTRA2F; // Create a target object for ASTRA2F
SamClarke 2:735bdcc06386 47 target_tle(2014, astra2f_tle, &ASTRA2F); // Parse a string TLE into the object, or set the object manually (below)
SamClarke 2:735bdcc06386 48
SamClarke 0:78d4704bd4e7 49 // NOAA 19
SamClarke 0:78d4704bd4e7 50 //1 33591U 09005A 14018.50690348 .00000100 00000-0 79451-4 0 929
SamClarke 0:78d4704bd4e7 51 //2 33591 098.9294 324.1290 0014157 178.0460 233.2637 14.11623746254876
SamClarke 1:ab43ae956815 52 struct Target NOAA19;
SamClarke 2:735bdcc06386 53 target_data(2014, 18.50690348, 98.9294, 324.1290, 79451,
SamClarke 2:735bdcc06386 54 178.0460, 233.2637, 14.1162376, 0.00000100, 25487, &NOAA19);
SamClarke 2:735bdcc06386 55
SamClarke 0:78d4704bd4e7 56 gps.Init();
SamClarke 0:78d4704bd4e7 57 pc.baud(115200);
SamClarke 0:78d4704bd4e7 58 while (1)
SamClarke 0:78d4704bd4e7 59 {
SamClarke 0:78d4704bd4e7 60 wait(1);
SamClarke 0:78d4704bd4e7 61 if(gps.parseData()) {
SamClarke 0:78d4704bd4e7 62 calculate(p, gps, &ASTRA2F);
SamClarke 2:735bdcc06386 63 pc.printf("GPS Position--------[ %f, %f ]\n\n", gps.latitude, gps.longitude);
SamClarke 2:735bdcc06386 64 pc.printf("ASTRA2F Azimuth-----[ %f ]\n", ASTRA2F.azimuth);
SamClarke 2:735bdcc06386 65 pc.printf("ASTRA2F Elevation---[ %f ]\n\n", ASTRA2F.elevation);
SamClarke 0:78d4704bd4e7 66 calculate(p, gps, &NOAA19);
SamClarke 2:735bdcc06386 67 pc.printf("NOAA19 Azimuth -----[ %f ]\n", NOAA19.azimuth);
SamClarke 2:735bdcc06386 68 pc.printf("NOAA19 Elevation----[ %f ]\n\n", NOAA19.elevation);
SamClarke 0:78d4704bd4e7 69 }else {
SamClarke 0:78d4704bd4e7 70 pc.printf("Aquiring Satellites...\n");
SamClarke 0:78d4704bd4e7 71 }
SamClarke 0:78d4704bd4e7 72 }
SamClarke 0:78d4704bd4e7 73
SamClarke 0:78d4704bd4e7 74 }
SamClarke 0:78d4704bd4e7 75
SamClarke 1:ab43ae956815 76 void calculate(Plan13& p, GPS& g, struct Target *t )
SamClarke 0:78d4704bd4e7 77 {
SamClarke 0:78d4704bd4e7 78 p.setTime(g.year,g.month,g.day,g.hours, g.minutes, g.seconds); //YMDHMS
SamClarke 0:78d4704bd4e7 79 p.setElements(t->YEAR,
SamClarke 0:78d4704bd4e7 80 t->EPOCH,
SamClarke 0:78d4704bd4e7 81 t->INCLINATION,
SamClarke 0:78d4704bd4e7 82 t->RAAN,
SamClarke 0:78d4704bd4e7 83 t->ECCENTRICITY*ONEPPTM,
SamClarke 0:78d4704bd4e7 84 t->ARGUMENT_PEDIGREE,
SamClarke 0:78d4704bd4e7 85 t->MEAN_ANOMALY,
SamClarke 0:78d4704bd4e7 86 t->MEAN_MOTION,
SamClarke 0:78d4704bd4e7 87 t->TIME_MOTION_D,
SamClarke 0:78d4704bd4e7 88 t->EPOCH_ORBIT+ONEPPM,
SamClarke 0:78d4704bd4e7 89 0);
SamClarke 3:e7cebcde3db7 90 p.setLocation(g.longitude,g.latitude,g.altitude);
SamClarke 0:78d4704bd4e7 91 p.calculate();
SamClarke 0:78d4704bd4e7 92 t->azimuth = p.AZ;
SamClarke 0:78d4704bd4e7 93 t->elevation = p.EL;
SamClarke 0:78d4704bd4e7 94 }
SamClarke 0:78d4704bd4e7 95
SamClarke 2:735bdcc06386 96 void target_data(int yr, float epoch, float inc, float raan,
SamClarke 3:e7cebcde3db7 97 float ecc, float arg, float anom, float mmotion,
SamClarke 3:e7cebcde3db7 98 float tmotion, float epoch_orbit, struct Target *t)
SamClarke 0:78d4704bd4e7 99 {
SamClarke 0:78d4704bd4e7 100 t->YEAR = yr;
SamClarke 0:78d4704bd4e7 101 t->EPOCH = epoch;
SamClarke 0:78d4704bd4e7 102 t->INCLINATION = inc;
SamClarke 0:78d4704bd4e7 103 t->RAAN = raan;
SamClarke 0:78d4704bd4e7 104 t->ECCENTRICITY = ecc;
SamClarke 0:78d4704bd4e7 105 t->ARGUMENT_PEDIGREE = arg;
SamClarke 0:78d4704bd4e7 106 t->MEAN_ANOMALY = anom;
SamClarke 0:78d4704bd4e7 107 t->MEAN_MOTION = mmotion;
SamClarke 0:78d4704bd4e7 108 t->TIME_MOTION_D = tmotion;
SamClarke 0:78d4704bd4e7 109 t->EPOCH_ORBIT = epoch_orbit;
SamClarke 3:e7cebcde3db7 110 }
SamClarke 3:e7cebcde3db7 111
SamClarke 3:e7cebcde3db7 112 void target_tle(int year, char *tle, struct Target *t){
SamClarke 3:e7cebcde3db7 113 t->YEAR = year;
SamClarke 3:e7cebcde3db7 114 sscanf(tle,
SamClarke 3:e7cebcde3db7 115 "%*s %*s %*s %*s %*c%*c%*c%f %f %*s %f%*c%*c %*c %*s %*s %f %f "
SamClarke 3:e7cebcde3db7 116 "%*s %f %f %f%*c%f",
SamClarke 3:e7cebcde3db7 117 &t->EPOCH, &t->TIME_MOTION_D, &t->ECCENTRICITY, &t->INCLINATION, &t->RAAN,
SamClarke 3:e7cebcde3db7 118 &t->ARGUMENT_PEDIGREE, &t->MEAN_ANOMALY, &t->MEAN_MOTION, &t->EPOCH_ORBIT);
SamClarke 0:78d4704bd4e7 119 }