ts1325-led.adb

RTEMS (Real-Time Executive for Multiprocessor Systems) is a free open source real-time operating sys

package body TS1325.LED is

   protected body LED_State is

      function Get return LED_Colour is
         State: Byte;
         Red_On, Green_On: Boolean;
      begin
         Inport (LED_Port, State);

         Green_On := (State and Green_Bit) = Green_Bit;
         Red_On := (State and Red_Bit) /= Red_Bit;

         if not (Green_On or Red_On) then
            return Off;
         elsif Green_On and not Red_On then
            return Green;
         elsif Green_On and Red_On then
            return Yellow;
         else
            return Red;
         end if;
      end Get;

      procedure Set (Col: in LED_Colour) is
         State: Byte;
      begin
         Inport (LED_Port, State);

         case Col is
            when Off =>
               State := (State and not Green_Bit) or Red_Bit;
            when Green =>
               State := State or Green_Bit or Red_Bit;
            when Yellow =>
               State := (State or Green_Bit) and not Red_Bit;
            when Red =>
               State := State and not (Green_Bit or Red_Bit);
         end case;

         Outport (LED_Port, State);
      end Set;

   end LED_State;

end TS1325.LED;