Update Control LEDs based on speed logic
This commit is contained in:
		
							parent
							
								
									2b539ed0b9
								
							
						
					
					
						commit
						13be37ba82
					
				
							
								
								
									
										26
									
								
								main.c
								
								
								
								
							
							
						
						
									
										26
									
								
								main.c
								
								
								
								
							| 
						 | 
				
			
			@ -34,6 +34,32 @@ void GPIO_PORT_B_init(void)
 | 
			
		|||
    UART1_IM_R |= 0x10;
 | 
			
		||||
    NVIC_EN0_R |= (1 << 6);
 | 
			
		||||
}
 | 
			
		||||
// Control LEDs based on speed
 | 
			
		||||
void control_leds_based_on_speed(float speed_kmh) {
 | 
			
		||||
    // Clear all LED bits (assuming LEDs are connected to bits 1, 2, and 3)
 | 
			
		||||
    GPIO_PORTF_DATA_R &= 0x00;
 | 
			
		||||
 | 
			
		||||
    // Determine which 5 km/h range the speed falls into
 | 
			
		||||
    if (speed_kmh >= 0.0 && speed_kmh < 10.0) {
 | 
			
		||||
        // Range 0-10 km/h
 | 
			
		||||
        GPIO_PORTF_DATA_R |= 0x08;  // Red LED
 | 
			
		||||
    } else if (speed_kmh >= 10.0 && speed_kmh < 20.0) {
 | 
			
		||||
        // Range 10-20 km/h
 | 
			
		||||
        GPIO_PORTF_DATA_R |= 0x0C;  // Blue LED
 | 
			
		||||
    } else if (speed_kmh >= 20.0 && speed_kmh < 30.0) {
 | 
			
		||||
        // Range 20-30 km/h
 | 
			
		||||
        GPIO_PORTF_DATA_R |= 0x04;  // Green LED
 | 
			
		||||
    } else if (speed_kmh >= 30.0 && speed_kmh < 40.0) {
 | 
			
		||||
        // Range 30-40 km/h
 | 
			
		||||
        GPIO_PORTF_DATA_R |= 0x06;  // Yellow LED (Red + Green)
 | 
			
		||||
    } else if (speed_kmh >= 40.0 && speed_kmh < 50.0) {
 | 
			
		||||
        // Range 40-50 km/h
 | 
			
		||||
        GPIO_PORTF_DATA_R |= 0x02;  // Blue LED
 | 
			
		||||
    } else {
 | 
			
		||||
        // Above 50 km/h
 | 
			
		||||
        GPIO_PORTF_DATA_R |= 0x0E;  // Maximum LED (Red + Blue + Green)
 | 
			
		||||
    }
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
		Reference in New Issue