Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- // add code here
- //Bearing checks
- for (uint16_t i = 0; i < strip.numPixels(); i++)
- {
- strip.setPixelColor(i, strip.Color(0, 0, 0));
- }
- if (heading >= 338.0f || heading < 22.0f)
- {
- strip.setPixelColor(11, strip.Color(5, 5, 5));
- }
- else if (heading >= 22.0f && heading < 68.0f)
- {
- strip.setPixelColor(12, strip.Color(5, 5, 5));
- }
- else if (heading >= 68.0f && heading < 112.0f)
- {
- strip.setPixelColor(20, strip.Color(5, 5, 5));
- }
- else if (heading >= 112.0f && heading < 158.0f)
- {
- strip.setPixelColor(28, strip.Color(5, 5, 5));
- }
- else if (heading >= 158.0f && heading < 202.0f)
- {
- strip.setPixelColor(27, strip.Color(5, 5, 5));
- }
- else if (heading >= 202.0f && heading < 248.0f)
- {
- strip.setPixelColor(26, strip.Color(5, 5, 5));
- }
- else if (heading >= 248.0f && heading < 292.0f)
- {
- strip.setPixelColor(18, strip.Color(5, 5, 5));
- }
- else if (heading >= 292.0f && heading < 338.0f)
- {
- strip.setPixelColor(10, strip.Color(5, 5, 5));
- }
- //end Bearing checks
- //Distance checks
- if (distance >= 200)
- {
- strip.setPixelColor(39, strip.Color(5, 0, 0));
- if (distance >= 400)
- {
- strip.setPixelColor(31, strip.Color(5, 0, 0));
- if (distance >= 600)
- {
- strip.setPixelColor(23, strip.Color(5, 0, 0));
- if (distance >= 800)
- {
- strip.setPixelColor(15, strip.Color(5, 0, 0));
- if (distance >= 1000)
- {
- strip.setPixelColor(7, strip.Color(5, 0, 0));
- if (distance >= 1200)
- {
- strip.setPixelColor(38, strip.Color(5, 0, 0));
- if (distance >= 1400)
- {
- strip.setPixelColor(30, strip.Color(5, 0, 0));
- if (distance >= 1600)
- {
- strip.setPixelColor(22, strip.Color(5, 0, 0));
- if (distance >= 1800)
- {
- strip.setPixelColor(14, strip.Color(5, 0, 0));
- if (distance >= 2000)
- {
- strip.setPixelColor(6, strip.Color(5, 0, 0));
- if (distance >= 2200)
- {
- strip.setPixelColor(37, strip.Color(5, 0, 0));
- if (distance >= 2400)
- {
- strip.setPixelColor(29, strip.Color(5, 0, 0));
- if (distance >= 2600)
- {
- strip.setPixelColor(13, strip.Color(5, 0, 0));
- if (distance >= 2800)
- {
- strip.setPixelColor(5, strip.Color(5, 0, 0));
- }
- }
- }
- }
- }
- }
- }
- }
- }
- }
- }
- }
- }
- }
- else
- {
- if (distance >= 20)
- {
- strip.setPixelColor(39, strip.Color(0, 5, 0));
- if (distance >= 40)
- {
- strip.setPixelColor(31, strip.Color(1, 5, 0));
- if (distance >= 60)
- {
- strip.setPixelColor(23, strip.Color(2, 5, 0));
- if (distance >= 80)
- {
- strip.setPixelColor(15, strip.Color(4, 5, 0));
- if (distance >= 100)
- {
- strip.setPixelColor(7, strip.Color(5, 5, 0));
- if (distance >= 120)
- {
- strip.setPixelColor(38, strip.Color(5, 4, 0));
- if (distance >= 140)
- {
- strip.setPixelColor(30, strip.Color(5, 2, 0));
- if (distance >= 160)
- {
- strip.setPixelColor(22, strip.Color(5, 1, 0));
- if (distance >= 180)
- {
- strip.setPixelColor(14, strip.Color(5, 0, 0));
- }
- }
- }
- }
- }
- }
- }
- }
- }
- }
- //end distance check
- //flag check
- switch (target)
- {
- case 0:
- strip.setPixelColor(32, strip.Color(5, 5, 5));
- break;
- case 1:
- strip.setPixelColor(24, strip.Color(5, 5, 5));
- break;
- case 2:
- strip.setPixelColor(16, strip.Color(5, 5, 5));
- break;
- case 3:
- strip.setPixelColor(8, strip.Color(5, 5, 5));
- break;
- }
- strip.setPixelColor(19, strip.Color(5, 5, 5));
- strip.show();
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement