Squash redundant code in PWM_status
This commit is contained in:
		
							parent
							
								
									af26d22741
								
							
						
					
					
						commit
						dbe414ef03
					
				| @ -675,168 +675,62 @@ static bool report_pin_name(int8_t pin, bool &pin_is_analog) { | ||||
|   return false; | ||||
| } // report_pin_name
 | ||||
| 
 | ||||
| //  True - currently a PWM pin
 | ||||
| #define PWM_PRINT(V) do{ sprintf(buffer, "PWM:  %4d", V); SERIAL_ECHO(buffer); }while(0) | ||||
| #define PWM_CASE(N) \ | ||||
|   case TIMER##N: \ | ||||
|     if (TCCR##N & (_BV(COM## N ##1) | _BV(COM## N ##0))) { \ | ||||
|       PWM_PRINT(OCR##N); \ | ||||
|       return true; \ | ||||
|     } else return false | ||||
| 
 | ||||
| /**
 | ||||
|  * Print a pin's PWM status. | ||||
|  * Return true if it's currently a PWM pin. | ||||
|  */ | ||||
| static bool PWM_status(uint8_t pin) { | ||||
|   char buffer[20];   // for the sprintf statements
 | ||||
| 
 | ||||
|   switch(digitalPinToTimer(pin)) { | ||||
| 
 | ||||
|     #if defined(TCCR0A) && defined(COM0A1) | ||||
|       case TIMER0A: | ||||
|         if (TCCR0A & (_BV(COM0A1) | _BV(COM0A0))){ | ||||
|           sprintf(buffer, "PWM:  %4d", OCR0A);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       case TIMER0B: | ||||
|         if (TCCR0A & (_BV(COM0B1) | _BV(COM0B0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR0B);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       PWM_CASE(0A); | ||||
|       PWM_CASE(0B); | ||||
|     #endif | ||||
| 
 | ||||
|     #if defined(TCCR1A) && defined(COM1A1) | ||||
|       case TIMER1A: | ||||
|         if (TCCR1A & (_BV(COM1A1) | _BV(COM1A0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR1A);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       case TIMER1B: | ||||
|         if (TCCR1A & (_BV(COM1B1) | _BV(COM1B0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR1B);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break;  | ||||
|       case TIMER1C: | ||||
|         if (TCCR1A & (_BV(COM1C1) | _BV(COM1C0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR1C);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       PWM_CASE(1A); | ||||
|       PWM_CASE(1B); | ||||
|       PWM_CASE(1C); | ||||
|     #endif | ||||
| 
 | ||||
|     #if defined(TCCR2A) && defined(COM2A1) | ||||
|       case TIMER2A: | ||||
|         if (TCCR2A & (_BV(COM2A1) | _BV(COM2A0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR2A);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       case TIMER2B: | ||||
|         if (TCCR2A & (_BV(COM2B1) | _BV(COM2B0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR2B);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       PWM_CASE(2A); | ||||
|       PWM_CASE(2B); | ||||
|     #endif | ||||
| 
 | ||||
|     #if defined(TCCR3A) && defined(COM3A1) | ||||
|       case TIMER3A: | ||||
|         if (TCCR3A & (_BV(COM3A1) | _BV(COM3A0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR3A);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       case TIMER3B: | ||||
|         if (TCCR3A & (_BV(COM3B1) | _BV(COM3B0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR3B);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       case TIMER3C: | ||||
|         if (TCCR3A & (_BV(COM3C1) | _BV(COM3C0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR3C);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       PWM_CASE(3A); | ||||
|       PWM_CASE(3B); | ||||
|       PWM_CASE(3C); | ||||
|     #endif | ||||
| 
 | ||||
|     #ifdef TCCR4A | ||||
|       case TIMER4A: | ||||
|         if (TCCR4A & (_BV(COM4A1) | _BV(COM4A0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR4A);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       case TIMER4B: | ||||
|         if (TCCR4A & (_BV(COM4B1) | _BV(COM4B0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR4B);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       case TIMER4C: | ||||
|         if (TCCR4A & (_BV(COM4C1) | _BV(COM4C0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR4C);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       PWM_CASE(4A); | ||||
|       PWM_CASE(4B); | ||||
|       PWM_CASE(4C); | ||||
|     #endif | ||||
| 
 | ||||
|     #if defined(TCCR5A) && defined(COM5A1) | ||||
|       case TIMER5A: | ||||
|         if (TCCR5A & (_BV(COM5A1) | _BV(COM5A0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR5A);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       case TIMER5B: | ||||
|         if (TCCR5A & (_BV(COM5B1) | _BV(COM5B0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR5B);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       case TIMER5C: | ||||
|         if (TCCR5A & (_BV(COM5C1) | _BV(COM5C0))){ | ||||
|           sprintf(buffer, "PWM:  %4d",OCR5C);  | ||||
|           SERIAL_ECHO(buffer); | ||||
|           return true; | ||||
|         } | ||||
|         else return false; | ||||
|         break; | ||||
|       PWM_CASE(5A); | ||||
|       PWM_CASE(5B); | ||||
|       PWM_CASE(5C); | ||||
|     #endif | ||||
| 
 | ||||
|     case NOT_ON_TIMER: | ||||
|       return false; | ||||
|       break; | ||||
|       | ||||
|     default: | ||||
|       return false; | ||||
| 
 | ||||
|   } | ||||
|    | ||||
|   SERIAL_PROTOCOLPGM("  ");    | ||||
|   SERIAL_PROTOCOLPGM("  "); | ||||
| }  //PWM_status
 | ||||
| 
 | ||||
| static void PWM_details(uint8_t pin) | ||||
|  | ||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user