view src/cs/drivers/drv_app/kpd/kpd_functions.c @ 686:59f07d67eb45

luna target split into luna1 and luna2 luna1 is FC Luna based on iWOW DSK v4.0 or v5.0 motherboard luna2 is FC Luna based on FC Caramel2 MB
author Mychaela Falconia <falcon@freecalypso.org>
date Mon, 12 Oct 2020 18:51:24 +0000
parents 945cf7f506b2
children
line wrap: on
line source

/**
 * @file   kpd_functions.c
 *
 * Implementation of Keypad functions.
 * These functions implement the keypad processing.
 *
 * @author   Laurent Sollier (l-sollier@ti.com)
 * @version 0.1
 */

/*
 * History:
 *
 *   Date          Author       Modification
 *  ----------------------------------------
 *  10/10/2001     L Sollier    Create
 *
 *
 * (C) Copyright 2001 by Texas Instruments Incorporated, All Rights Reserved
 */

#include "kpd/kpd_i.h"
#include "kpd/kpd_virtual_key_table_mgt.h"
#include "kpd/kpd_env.h"
#include "kpd/kpd_messages_i.h"

#include "rvf/rvf_api.h"
#include "rvm/rvm_use_id_list.h"

extern T_KPD_ENV_CTRL_BLK* kpd_env_ctrl_blk;


/* Define the max of subscribers supported by the keypad driver */
#define MAX_SUBSCRIBERS 32


#define KEY_MASK_SIZE_FOR_SN_MODE 20

/* This structure gather general informations about keypad */
typedef struct {  UINT32               reserved_subscriber_id;
                  UINT8                keypad_mode;
                  char                 sn_mode_notified_keys[KEY_MASK_SIZE_FOR_SN_MODE];
                  T_SUBSCRIBER_ID      owner_keypad_id;
               } T_KEYPAD_DRIVER_INFOS;

/* Keypad informations */
static T_KEYPAD_DRIVER_INFOS keypad_driver_infos;

/* Mutex used to protect reserved_subscriber_id variable */
static T_RVF_MUTEX mutex;


/**
 * @name Functions implementation
 *
 */
/*@{*/


/**
 * function: kpd_initialize_keypad_driver
 */
T_RV_RET kpd_initialize_keypad_driver(void)
{
   T_RV_RET ret = RV_OK;
   UINT8 i;

   /* Initialization of keypad_driver_infos */
   keypad_driver_infos.reserved_subscriber_id = 0;
   keypad_driver_infos.keypad_mode = MN_MODE;
   for (i = 0; i < KEY_MASK_SIZE_FOR_SN_MODE; i++)
      keypad_driver_infos.sn_mode_notified_keys[i] = 0;
   keypad_driver_infos.owner_keypad_id = 0;

   /* Initialize ASCII table */
   if (kpd_initialize_ascii_table() != RV_OK)
      ret = RV_INTERNAL_ERR;

   /* Check if number max of subscriber is supported by the driver */
   else if (KPD_MAX_SUBSCRIBER > MAX_SUBSCRIBERS)
      ret = RV_INTERNAL_ERR;

   /* Check validity of the vpm table */
   else if (kpd_vpm_table_is_valid() == FALSE)
      ret = RV_INTERNAL_ERR;

   /* Mutex initialization */
   else if (rvf_initialize_mutex(&mutex) != RVF_OK)
      ret =  RV_INTERNAL_ERR;

   /* Hardware initialization */
   kpd_initialize_keypad_hardware();

   if (ret ==  RV_INTERNAL_ERR)
      KPD_SEND_TRACE("Keypad driver initialization failed", RV_TRACE_LEVEL_ERROR);

   return ret;
}

/**
 * function: kpd_kill_keypad_driver
 */
T_RV_RET kpd_kill_keypad_driver(void)
{
   return rvf_delete_mutex(&mutex);
}


/**
 * function: kpd_add_subscriber
 */
T_RV_RET kpd_add_subscriber(T_SUBSCRIBER_ID* subscriber_id)
{
   UINT8 i;
   UINT8 nb_subscriber = 0;
   T_RV_RET ret = RV_OK;

   rvf_lock_mutex(&mutex);

   /* Check number of subscribers */
   for (i = 0; i < KPD_MAX_SUBSCRIBER; i++)
      if (keypad_driver_infos.reserved_subscriber_id & (1<<i))
         nb_subscriber++;

   if (nb_subscriber >= KPD_MAX_SUBSCRIBER)
   {
      KPD_SEND_TRACE("KPD: Max of subscriber reached", RV_TRACE_LEVEL_WARNING);
      ret = RV_INTERNAL_ERR;
   }
   else
   {
      for (i = 0; i < KPD_MAX_SUBSCRIBER; i++)
         if ( (keypad_driver_infos.reserved_subscriber_id & (1<<i)) == 0)
         {
            keypad_driver_infos.reserved_subscriber_id |= 1<<i;
            *subscriber_id = i;
            break;
         }
   }

   rvf_unlock_mutex(&mutex);

   return ret;
}

/**
 * function: kpd_remove_subscriber
 */
T_RV_RET kpd_remove_subscriber(T_SUBSCRIBER_ID subscriber_id)
{
   T_RV_RET ret = RV_OK;

   rvf_lock_mutex(&mutex);

   /* Check if subscriber id is correct */
   if (keypad_driver_infos.reserved_subscriber_id & (1<<subscriber_id) )
   {
      /* Unreserve the id */
      keypad_driver_infos.reserved_subscriber_id &= ~(1<<subscriber_id);
   }
   else
   {
      KPD_SEND_TRACE("KPD: Subscriber Id unknown", RV_TRACE_LEVEL_ERROR);
      ret = RV_INVALID_PARAMETER;
   }

   rvf_unlock_mutex(&mutex);

   return ret;
}

/**
 * function: kpd_subscriber_id_used
 */
BOOL kpd_subscriber_id_used(T_KPD_SUBSCRIBER subscriber, T_SUBSCRIBER_ID* subscriber_id)
{
   BOOL ret = FALSE;
   T_SUBSCRIBER_ID id;

   rvf_lock_mutex(&mutex);

   if (subscriber != 0)
   {
      id = ((T_SUBSCRIBER*) subscriber)->subscriber_id;
      *subscriber_id = id;

      /* Check if subscriber id is correct */
      if ( keypad_driver_infos.reserved_subscriber_id & (1<<id) )
         ret = TRUE;
   }

   rvf_unlock_mutex(&mutex);

   return ret;
}


/**
 * function: kpd_send_key_event_message
 */
void kpd_send_key_event_message(T_KPD_PHYSICAL_KEY_ID physical_key_pressed_id,
                                T_KPD_KEY_STATE state,
                                T_KPD_PRESS_STATE press_state,
                                T_KPD_MODE mode,
                                T_RV_RETURN return_path)
{
   T_RVF_MB_STATUS mb_status;
   T_KPD_KEY_EVENT_MSG* key_event;
   char* ascii_code;


   /* Subscriber must be notified by the pressed key */
   mb_status = rvf_get_buf (kpd_env_ctrl_blk->prim_id, sizeof(T_KPD_KEY_EVENT_MSG), (void **) &key_event);   

   if (mb_status != RVF_RED) /* Memory allocation success */
   {
      /* Fill the message */
      key_event->hdr.msg_id = KPD_KEY_EVENT_MSG;
      key_event->key_info.virtual_key_id = kpd_get_virtual_key(physical_key_pressed_id,
                                                               mode);
      key_event->key_info.state = state;
      key_event->key_info.press_state = press_state;
      kpd_get_ascii_key_value(physical_key_pressed_id,
                              mode,
                              &ascii_code);
      key_event->key_info.ascii_value_p = ascii_code;
      
      KPD_SEND_TRACE_PARAM("KPD: Virtual key Id sent: ", key_event->key_info.virtual_key_id, RV_TRACE_LEVEL_DEBUG_HIGH);

      /* Send message to the client */
      if (return_path.callback_func != 0)
      {
         return_path.callback_func((void*) key_event);
         rvf_free_buf(key_event);
      }
      else
      {
         rvf_send_msg(return_path.addr_id, key_event);
      }
   }
   else
   {
      KPD_SEND_TRACE("KPD: Memory allocation error", RV_TRACE_LEVEL_ERROR);
   }
}


/**
 * function: kpd_send_status_message
 */
void kpd_send_status_message(UINT8 operation, UINT8 status_value, T_RV_RETURN return_path)
{
   T_RVF_MB_STATUS mb_status;
   T_KPD_STATUS_MSG* msg_status;

   /* Reserve memory for message */
   mb_status = rvf_get_buf (kpd_env_ctrl_blk->prim_id, sizeof(T_KPD_STATUS_MSG), (void **) &msg_status);

   if (mb_status != RVF_RED) /* Memory allocation success */
   {
      /* Fill the message */
      msg_status->hdr.msg_id = KPD_STATUS_MSG;
      msg_status->operation = operation;
      msg_status->status_value = status_value;

      /* Send message to the client */
      if (return_path.callback_func != 0)
      {
         return_path.callback_func((void*) msg_status);
         rvf_free_buf(msg_status);

      }
      else
      {
         rvf_send_msg(return_path.addr_id, msg_status);
      }
      KPD_SEND_TRACE_PARAM("KPD: Sent status message, Id:", status_value, RV_TRACE_LEVEL_DEBUG_LOW);
   }
   else
   {
      KPD_SEND_TRACE("KPD: Memory allocation error", RV_TRACE_LEVEL_ERROR);
   }
}


/**
 * function: kpd_is_key_in_sn_mode
 */
BOOL kpd_is_key_in_sn_mode(T_KPD_PHYSICAL_KEY_ID physical_key_pressed_id)
{
   return ( (keypad_driver_infos.keypad_mode == SN_MODE)
          && (keypad_driver_infos.sn_mode_notified_keys[physical_key_pressed_id >> 3] & (1<<(physical_key_pressed_id & 0x07))) );
}


/**
 * function: kpd_set_keys_in_sn_mode
 */
void kpd_set_keys_in_sn_mode(T_KPD_VIRTUAL_KEY_TABLE* keys_owner, T_KPD_MODE mode)
{
   UINT8 i;
   INT8 position;

   for (i = 0; i < keys_owner->nb_notified_keys; i++)
   {
      /* Retrieve position in vpm table */
      kpd_retrieve_virtual_key_position(keys_owner->notified_keys[i],
                                        mode,
                                        &position);

      keypad_driver_infos.sn_mode_notified_keys[position >> 3] |= (1<<(position & 0x07));
   }
}


/**
 * function: kpd_is_owner_keypad
 */
BOOL kpd_is_owner_keypad(T_SUBSCRIBER_ID subscriber_id)
{
   return ( (keypad_driver_infos.keypad_mode == SN_MODE)
          && (keypad_driver_infos.owner_keypad_id == subscriber_id) );
}


/**
 * function: kpd_get_keypad_mode
 */
UINT8 kpd_get_keypad_mode(void)
{
   return keypad_driver_infos.keypad_mode;
}

/**
 * function: kpd_set_keypad_mode
 */
void kpd_set_keypad_mode(UINT8 mode)
{
   UINT8 i;

   keypad_driver_infos.keypad_mode = mode;

   if (mode == MN_MODE)
   {
      for (i = 0; i < KEY_MASK_SIZE_FOR_SN_MODE; i++)
         keypad_driver_infos.sn_mode_notified_keys[i] = 0;
   }
}

/**
 * function: kpd_get_owner_keypad_id
 */
T_SUBSCRIBER_ID kpd_get_owner_keypad_id(void)
{
   return keypad_driver_infos.owner_keypad_id;
}

/**
 * function: kpd_set_owner_keypad_id
 */
void kpd_set_owner_keypad_id(T_SUBSCRIBER_ID subscriber_id)
{
   keypad_driver_infos.owner_keypad_id = subscriber_id;
}


/*@}*/