Sam Clarke
/
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.
main.cpp@1:ab43ae956815, 2014-01-19 (annotated)
- Committer:
- SamClarke
- Date:
- Sun Jan 19 08:44:45 2014 +0000
- Revision:
- 1:ab43ae956815
- Parent:
- 0:78d4704bd4e7
- Child:
- 2:735bdcc06386
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| SamClarke | 0:78d4704bd4e7 | 1 | // Note!!!! This software is strictly beerware, send a beer |
| SamClarke | 0:78d4704bd4e7 | 2 | // to clarke.sam1@gmail.com via paypal if you use this code. |
| SamClarke | 0:78d4704bd4e7 | 3 | |
| SamClarke | 0:78d4704bd4e7 | 4 | |
| SamClarke | 0:78d4704bd4e7 | 5 | #include "Plan13.h" |
| SamClarke | 0:78d4704bd4e7 | 6 | #include "GPS.h" |
| SamClarke | 0:78d4704bd4e7 | 7 | #include "mbed.h" |
| SamClarke | 0:78d4704bd4e7 | 8 | |
| SamClarke | 0:78d4704bd4e7 | 9 | #define ONEPPM 1.0e-6 |
| SamClarke | 0:78d4704bd4e7 | 10 | #define ONEPPTM 1.0e-7 |
| SamClarke | 0:78d4704bd4e7 | 11 | |
| SamClarke | 1:ab43ae956815 | 12 | struct Target{ |
| SamClarke | 0:78d4704bd4e7 | 13 | int YEAR; |
| SamClarke | 0:78d4704bd4e7 | 14 | float EPOCH; |
| SamClarke | 0:78d4704bd4e7 | 15 | float INCLINATION; |
| SamClarke | 0:78d4704bd4e7 | 16 | float RAAN; |
| SamClarke | 0:78d4704bd4e7 | 17 | float ECCENTRICITY; |
| SamClarke | 0:78d4704bd4e7 | 18 | float ARGUMENT_PEDIGREE; |
| SamClarke | 0:78d4704bd4e7 | 19 | float MEAN_ANOMALY; |
| SamClarke | 0:78d4704bd4e7 | 20 | float MEAN_MOTION; |
| SamClarke | 0:78d4704bd4e7 | 21 | float TIME_MOTION_D; |
| SamClarke | 0:78d4704bd4e7 | 22 | float EPOCH_ORBIT; |
| SamClarke | 0:78d4704bd4e7 | 23 | float azimuth; |
| SamClarke | 0:78d4704bd4e7 | 24 | float elevation; |
| SamClarke | 0:78d4704bd4e7 | 25 | }; |
| SamClarke | 0:78d4704bd4e7 | 26 | |
| SamClarke | 0:78d4704bd4e7 | 27 | void target_tle(int yr, float epoch, float inc, float raan, |
| SamClarke | 0:78d4704bd4e7 | 28 | float ecc, float arg, float anom, float mmotion, |
| SamClarke | 1:ab43ae956815 | 29 | float tmotion, float epoch_orbit, struct Target *t); |
| SamClarke | 0:78d4704bd4e7 | 30 | |
| SamClarke | 1:ab43ae956815 | 31 | void calculate(Plan13& p, GPS& g, struct Target *t); |
| SamClarke | 0:78d4704bd4e7 | 32 | |
| SamClarke | 0:78d4704bd4e7 | 33 | Serial pc(USBTX, USBRX); |
| SamClarke | 0:78d4704bd4e7 | 34 | GPS gps(p9,p10); |
| SamClarke | 0:78d4704bd4e7 | 35 | Plan13 p; |
| SamClarke | 0:78d4704bd4e7 | 36 | |
| SamClarke | 0:78d4704bd4e7 | 37 | int main() |
| SamClarke | 0:78d4704bd4e7 | 38 | { |
| SamClarke | 0:78d4704bd4e7 | 39 | // ASTRA 2F |
| SamClarke | 0:78d4704bd4e7 | 40 | //1 38778U 12051A 14010.00000000 .00000143 00000-0 00000+0 0 2381 |
| SamClarke | 0:78d4704bd4e7 | 41 | //2 38778 000.0670 267.2510 0004011 341.2500 249.1500 01.00276604 4755 |
| SamClarke | 1:ab43ae956815 | 42 | struct Target ASTRA2F; |
| SamClarke | 0:78d4704bd4e7 | 43 | target_tle(2014, 10.00000000, 000.0670, 267.2510, 0, |
| SamClarke | 0:78d4704bd4e7 | 44 | 341.2500, 249.1500, 1.0027660, 0.00000143, 4755, &ASTRA2F); |
| SamClarke | 0:78d4704bd4e7 | 45 | // NOAA 19 |
| SamClarke | 0:78d4704bd4e7 | 46 | //1 33591U 09005A 14018.50690348 .00000100 00000-0 79451-4 0 929 |
| SamClarke | 0:78d4704bd4e7 | 47 | //2 33591 098.9294 324.1290 0014157 178.0460 233.2637 14.11623746254876 |
| SamClarke | 1:ab43ae956815 | 48 | struct Target NOAA19; |
| SamClarke | 0:78d4704bd4e7 | 49 | target_tle(2014, 18.50690348, 98.9294, 324.1290, 79451, |
| SamClarke | 0:78d4704bd4e7 | 50 | 178.0460, 233.2637, 14.1162376, 0.00000100, 25487, &NOAA19); |
| SamClarke | 0:78d4704bd4e7 | 51 | gps.Init(); |
| SamClarke | 0:78d4704bd4e7 | 52 | pc.baud(115200); |
| SamClarke | 0:78d4704bd4e7 | 53 | while (1) |
| SamClarke | 0:78d4704bd4e7 | 54 | { |
| SamClarke | 0:78d4704bd4e7 | 55 | wait(1); |
| SamClarke | 0:78d4704bd4e7 | 56 | if(gps.parseData()) { |
| SamClarke | 0:78d4704bd4e7 | 57 | calculate(p, gps, &ASTRA2F); |
| SamClarke | 0:78d4704bd4e7 | 58 | pc.printf("GPS Position = %f, %f\n\n", gps.latitude, gps.longitude); |
| SamClarke | 0:78d4704bd4e7 | 59 | pc.printf("ASTRA2F Azimuth = %f\n", ASTRA2F.azimuth); |
| SamClarke | 0:78d4704bd4e7 | 60 | pc.printf("ASTRA2F Elevation = %f\n", ASTRA2F.elevation); |
| SamClarke | 0:78d4704bd4e7 | 61 | calculate(p, gps, &NOAA19); |
| SamClarke | 0:78d4704bd4e7 | 62 | pc.printf("NOAA19 Azimuth = %f\n", NOAA19.azimuth); |
| SamClarke | 0:78d4704bd4e7 | 63 | pc.printf("NOAA19 Elevation = %f\n\n", NOAA19.elevation); |
| SamClarke | 0:78d4704bd4e7 | 64 | }else { |
| SamClarke | 0:78d4704bd4e7 | 65 | pc.printf("Aquiring Satellites...\n"); |
| SamClarke | 0:78d4704bd4e7 | 66 | } |
| SamClarke | 0:78d4704bd4e7 | 67 | } |
| SamClarke | 0:78d4704bd4e7 | 68 | |
| SamClarke | 0:78d4704bd4e7 | 69 | } |
| SamClarke | 0:78d4704bd4e7 | 70 | |
| SamClarke | 1:ab43ae956815 | 71 | void calculate(Plan13& p, GPS& g, struct Target *t ) |
| SamClarke | 0:78d4704bd4e7 | 72 | { |
| SamClarke | 0:78d4704bd4e7 | 73 | p.setTime(g.year,g.month,g.day,g.hours, g.minutes, g.seconds); //YMDHMS |
| SamClarke | 0:78d4704bd4e7 | 74 | p.setElements(t->YEAR, |
| SamClarke | 0:78d4704bd4e7 | 75 | t->EPOCH, |
| SamClarke | 0:78d4704bd4e7 | 76 | t->INCLINATION, |
| SamClarke | 0:78d4704bd4e7 | 77 | t->RAAN, |
| SamClarke | 0:78d4704bd4e7 | 78 | t->ECCENTRICITY*ONEPPTM, |
| SamClarke | 0:78d4704bd4e7 | 79 | t->ARGUMENT_PEDIGREE, |
| SamClarke | 0:78d4704bd4e7 | 80 | t->MEAN_ANOMALY, |
| SamClarke | 0:78d4704bd4e7 | 81 | t->MEAN_MOTION, |
| SamClarke | 0:78d4704bd4e7 | 82 | t->TIME_MOTION_D, |
| SamClarke | 0:78d4704bd4e7 | 83 | t->EPOCH_ORBIT+ONEPPM, |
| SamClarke | 0:78d4704bd4e7 | 84 | 0); |
| SamClarke | 0:78d4704bd4e7 | 85 | p.setLocation(g.longitude,g.latitude,0); |
| SamClarke | 0:78d4704bd4e7 | 86 | p.calculate(); |
| SamClarke | 0:78d4704bd4e7 | 87 | t->azimuth = p.AZ; |
| SamClarke | 0:78d4704bd4e7 | 88 | t->elevation = p.EL; |
| SamClarke | 0:78d4704bd4e7 | 89 | } |
| SamClarke | 0:78d4704bd4e7 | 90 | |
| SamClarke | 0:78d4704bd4e7 | 91 | void target_tle(int yr, float epoch, float inc, float raan, |
| SamClarke | 0:78d4704bd4e7 | 92 | float ecc, float arg, float anom, float mmotion, |
| SamClarke | 1:ab43ae956815 | 93 | float tmotion, float epoch_orbit, struct Target *t) |
| SamClarke | 0:78d4704bd4e7 | 94 | { |
| SamClarke | 0:78d4704bd4e7 | 95 | t->YEAR = yr; |
| SamClarke | 0:78d4704bd4e7 | 96 | t->EPOCH = epoch; |
| SamClarke | 0:78d4704bd4e7 | 97 | t->INCLINATION = inc; |
| SamClarke | 0:78d4704bd4e7 | 98 | t->RAAN = raan; |
| SamClarke | 0:78d4704bd4e7 | 99 | t->ECCENTRICITY = ecc; |
| SamClarke | 0:78d4704bd4e7 | 100 | t->ARGUMENT_PEDIGREE = arg; |
| SamClarke | 0:78d4704bd4e7 | 101 | t->MEAN_ANOMALY = anom; |
| SamClarke | 0:78d4704bd4e7 | 102 | t->MEAN_MOTION = mmotion; |
| SamClarke | 0:78d4704bd4e7 | 103 | t->TIME_MOTION_D = tmotion; |
| SamClarke | 0:78d4704bd4e7 | 104 | t->EPOCH_ORBIT = epoch_orbit; |
| SamClarke | 0:78d4704bd4e7 | 105 | } |