_mqx_int _io_serial_int_close
(
/* [IN] the file handle for the device being closed */
FILE_DEVICE_STRUCT_PTR fd_ptr
)
{ /* Body */
IO_DEVICE_STRUCT_PTR io_dev_ptr;
IO_SERIAL_INT_DEVICE_STRUCT_PTR int_io_dev_ptr;
_mqx_int result = MQX_OK;
_mqx_int ioctl_val;
io_dev_ptr = fd_ptr->DEV_PTR;
int_io_dev_ptr = (pointer)io_dev_ptr->DRIVER_INIT_PTR;
if (--int_io_dev_ptr->COUNT == 0) {
if (int_io_dev_ptr->DEV_IOCTL != NULL) {
if (fd_ptr->FLAGS & IO_SERIAL_HW_FLOW_CONTROL) {
ioctl_val = IO_SERIAL_RTS;
(*int_io_dev_ptr->DEV_IOCTL)(int_io_dev_ptr->DEV_INFO_PTR, IO_IOCTL_SERIAL_CLEAR_HW_SIGNAL, &ioctl_val);
}
}
if (int_io_dev_ptr->DEV_DEINIT) {
result = (*int_io_dev_ptr->DEV_DEINIT)(int_io_dev_ptr->DEV_INIT_DATA_PTR,
int_io_dev_ptr->DEV_INFO_PTR);
} /* Endif */
_mem_free(int_io_dev_ptr->IN_QUEUE);
_mem_free(int_io_dev_ptr->OUT_QUEUE);
_taskq_destroy(int_io_dev_ptr->IN_WAITING_TASKS);
_taskq_destroy(int_io_dev_ptr->OUT_WAITING_TASKS);
} /* Endif */
return(result);
} /* Endbody */
static _mqx_int _io_serial_mix_close
(
/* [IN] the file handle for the device being closed */
FILE_DEVICE_STRUCT_PTR fd_ptr
)
{ /* Body */
IO_DEVICE_STRUCT_PTR io_dev_ptr;
IO_SERIAL_INT_DEVICE_STRUCT_PTR int_io_dev_ptr;
_mqx_int result = MQX_OK;
_mqx_int ioctl_val;
/* other task cannot break 'close' function */
_int_disable();
io_dev_ptr = fd_ptr->DEV_PTR;
int_io_dev_ptr = (void *)io_dev_ptr->DRIVER_INIT_PTR;
/* flush the output buffer before closing */
(*io_dev_ptr->IO_IOCTL)(fd_ptr, IO_IOCTL_FLUSH_OUTPUT, NULL);
if (--int_io_dev_ptr->COUNT == 0) {
if (int_io_dev_ptr->DEV_DEINIT) {
result = (*int_io_dev_ptr->DEV_DEINIT)(int_io_dev_ptr->DEV_INIT_DATA_PTR,
int_io_dev_ptr->DEV_INFO_PTR);
} /* Endif */
_mem_free(int_io_dev_ptr->OUT_QUEUE);
int_io_dev_ptr->OUT_QUEUE = NULL;
_taskq_destroy(int_io_dev_ptr->IN_WAITING_TASKS);
_taskq_destroy(int_io_dev_ptr->OUT_WAITING_TASKS);
} /* Endif */
_int_enable();
return(result);
} /* Endbody */
static _mqx_int _io_serial_mix_open
(
/* [IN] the file handle for the device being opened */
FILE_DEVICE_STRUCT_PTR fd_ptr,
/* [IN] the remaining portion of the name of the device */
char *open_name_ptr,
/* [IN] the flags to be used during operation:
** echo, translation, xon/xoff
*/
char *flags
)
{ /* Body */
IO_DEVICE_STRUCT_PTR io_dev_ptr;
IO_SERIAL_INT_DEVICE_STRUCT_PTR int_io_dev_ptr;
_mqx_uint result = MQX_OK;
_mqx_uint ioctl_val;
io_dev_ptr = fd_ptr->DEV_PTR;
int_io_dev_ptr = (void *)io_dev_ptr->DRIVER_INIT_PTR;
if (int_io_dev_ptr->COUNT) {
/* Device is already opened */
int_io_dev_ptr->COUNT++;
fd_ptr->FLAGS = int_io_dev_ptr->FLAGS;
return(result);
} /* Endif */
int_io_dev_ptr->IN_WAITING_TASKS = _taskq_create(MQX_TASK_QUEUE_FIFO);
int_io_dev_ptr->OUT_WAITING_TASKS = _taskq_create(MQX_TASK_QUEUE_FIFO);
int_io_dev_ptr->OUT_QUEUE = (void *)_mem_alloc_system(
sizeof(CHARQ_STRUCT) - (4 * sizeof(char)) + int_io_dev_ptr->OQUEUE_SIZE);
_mem_set_type(int_io_dev_ptr->OUT_QUEUE,MEM_TYPE_IO_SERIAL_OUT_QUEUE);
_CHARQ_INIT(int_io_dev_ptr->OUT_QUEUE, int_io_dev_ptr->OQUEUE_SIZE);
int_io_dev_ptr->FLAGS = (_mqx_uint)flags;
fd_ptr->FLAGS = (_mqx_uint)flags;
result = (*int_io_dev_ptr->DEV_INIT)(int_io_dev_ptr, open_name_ptr);
if (result == MQX_OK) {
result = (*int_io_dev_ptr->DEV_ENABLE_INTS)(int_io_dev_ptr->DEV_INFO_PTR);
} /* Endif */
if (result != MQX_OK) {
_mem_free(int_io_dev_ptr->OUT_QUEUE);
_taskq_destroy(int_io_dev_ptr->IN_WAITING_TASKS);
_taskq_destroy(int_io_dev_ptr->OUT_WAITING_TASKS);
}
int_io_dev_ptr->COUNT = 1;
return(result);
} /* Endbody */
_mqx_int _io_serial_int_close
(
/* [IN] the file handle for the device being closed */
FILE_DEVICE_STRUCT_PTR fd_ptr
)
{ /* Body */
IO_DEVICE_STRUCT_PTR io_dev_ptr;
IO_SERIAL_INT_DEVICE_STRUCT_PTR int_io_dev_ptr;
_mqx_int result = MQX_OK;
_mqx_int ioctl_val;
/* other task cannot break 'close' function */
_int_disable();
io_dev_ptr = fd_ptr->DEV_PTR;
int_io_dev_ptr = (void *)io_dev_ptr->DRIVER_INIT_PTR;
/* flush the output buffer before closing */
(*io_dev_ptr->IO_IOCTL)(fd_ptr, IO_IOCTL_FLUSH_OUTPUT, NULL);
if (--int_io_dev_ptr->COUNT == 0) {
if (int_io_dev_ptr->DEV_IOCTL != NULL) {
if (fd_ptr->FLAGS & IO_SERIAL_HW_FLOW_CONTROL) {
ioctl_val = IO_SERIAL_RTS;
(*int_io_dev_ptr->DEV_IOCTL)(int_io_dev_ptr->DEV_INFO_PTR, IO_IOCTL_SERIAL_CLEAR_HW_SIGNAL, &ioctl_val);
}
}
if (int_io_dev_ptr->DEV_DEINIT) {
#if MQX_ENABLE_LOW_POWER
_lwsem_wait (&(int_io_dev_ptr->LPM_INFO.LOCK));
#endif
result = (*int_io_dev_ptr->DEV_DEINIT)(int_io_dev_ptr->DEV_INIT_DATA_PTR,
int_io_dev_ptr->DEV_INFO_PTR);
#if MQX_ENABLE_LOW_POWER
_lwsem_post (&(int_io_dev_ptr->LPM_INFO.LOCK));
#endif
} /* Endif */
_mem_free(int_io_dev_ptr->IN_QUEUE);
int_io_dev_ptr->IN_QUEUE = NULL;
_mem_free(int_io_dev_ptr->OUT_QUEUE);
int_io_dev_ptr->OUT_QUEUE = NULL;
_taskq_destroy(int_io_dev_ptr->IN_WAITING_TASKS);
_taskq_destroy(int_io_dev_ptr->OUT_WAITING_TASKS);
} /* Endif */
_int_enable();
return(result);
} /* Endbody */
uint_32 _core_mutex_create_internal(CORE_MUTEX_PTR mutex_ptr, uint_32 core_num, uint_32 mutex_num, uint_32 policy, boolean allocated )
{
CORE_MUTEX_COMPONENT_PTR component_ptr = _core_mutext_get_component_ptr();
#if MQX_CHECK_ERRORS
if (component_ptr == NULL) {
return MQX_COMPONENT_DOES_NOT_EXIST;
}
// range check mutex_id
if (mutex_num>=SEMA4_NUM_GATES) {
return (MQX_INVALID_PARAMETER);
}
if (core_num>=PSP_NUM_CORES) {
return (MQX_INVALID_PARAMETER);
}
if (mutex_ptr==NULL) {
return MQX_INVALID_PARAMETER;
}
#endif
mutex_ptr->VALID = CORE_MUTEX_VALID;
mutex_ptr->GATE_NUM = mutex_num;
mutex_ptr->GATE_PTR = &(component_ptr->DEVICE[core_num].SEMA4_PTR->GATE[mutex_ptr->GATE_NUM]);
mutex_ptr->WAIT_Q = _taskq_create(policy);
#if MQX_CHECK_ERRORS
if (mutex_ptr->WAIT_Q==NULL) {
return MQX_TASKQ_CREATE_FAILED;
}
#endif
_int_disable();
#if MQX_CHECK_ERRORS
if (component_ptr->DEVICE[core_num].MUTEX_PTR[mutex_num] !=NULL) {
_int_enable();
_taskq_destroy(mutex_ptr->WAIT_Q);
return MQX_COMPONENT_EXISTS;
}
#endif
component_ptr->DEVICE[core_num].MUTEX_PTR[mutex_num]=mutex_ptr;
// Need to remember if we allocated this mutex, or user did
if (allocated) {
component_ptr->DEVICE[core_num].ALLOCED |= (1<<mutex_num);
}
// Enable 'unlocked' interrupt for this core
if (_psp_core_num()==0) {
component_ptr->DEVICE[core_num].SEMA4_PTR->CP0INE |= 1 << (SEMA4_NUM_GATES - 1 - idx[mutex_num]); //1 << (SEMA4_NUM_GATES-1-mutex_num);
} else {
component_ptr->DEVICE[core_num].SEMA4_PTR->CP1INE |= 1 << (SEMA4_NUM_GATES - 1 - idx[mutex_num]); //1 << (SEMA4_NUM_GATES-1-mutex_num);
}
_int_enable();
return COREMUTEX_OK;
}
_mqx_int _io_serial_int_uninstall
(
/* [IN] The IO device structure for the device */
IO_DEVICE_STRUCT_PTR io_dev_ptr
)
{ /* Body */
IO_SERIAL_INT_DEVICE_STRUCT_PTR int_dev_ptr = io_dev_ptr->DRIVER_INIT_PTR;
if (int_dev_ptr->COUNT == 0) {
if (int_dev_ptr->DEV_DEINIT) {
#if MQX_ENABLE_LOW_POWER
_lwsem_wait (&(int_dev_ptr->LPM_INFO.LOCK));
#endif
(*int_dev_ptr->DEV_DEINIT)(int_dev_ptr->DEV_INIT_DATA_PTR,
int_dev_ptr->DEV_INFO_PTR);
#if MQX_ENABLE_LOW_POWER
_lwsem_post (&(int_dev_ptr->LPM_INFO.LOCK));
#endif
} /* Endif */
_mem_free(int_dev_ptr->IN_QUEUE);
_mem_free(int_dev_ptr->OUT_QUEUE);
_taskq_destroy(int_dev_ptr->IN_WAITING_TASKS);
_taskq_destroy(int_dev_ptr->OUT_WAITING_TASKS);
#if MQX_ENABLE_LOW_POWER
_lpm_unregister_driver (int_dev_ptr->LPM_INFO.REGISTRATION_HANDLE);
_lwsem_destroy (&(int_dev_ptr->LPM_INFO.LOCK));
#endif
_mem_free(int_dev_ptr);
return(IO_OK);
} else {
return(IO_ERROR_DEVICE_BUSY);
} /* Endif */
} /* Endbody */
_mqx_int _io_serial_int_uninstall
(
/* [IN] The IO device structure for the device */
IO_DEVICE_STRUCT_PTR io_dev_ptr
)
{ /* Body */
IO_SERIAL_INT_DEVICE_STRUCT_PTR int_dev_ptr = io_dev_ptr->DRIVER_INIT_PTR;
if (int_dev_ptr->COUNT == 0) {
if (int_dev_ptr->DEV_DEINIT) {
(*int_dev_ptr->DEV_DEINIT)(int_dev_ptr->DEV_INIT_DATA_PTR,
int_dev_ptr->DEV_INFO_PTR);
} /* Endif */
_mem_free(int_dev_ptr->IN_QUEUE);
_mem_free(int_dev_ptr->OUT_QUEUE);
_taskq_destroy(int_dev_ptr->IN_WAITING_TASKS);
_taskq_destroy(int_dev_ptr->OUT_WAITING_TASKS);
_mem_free(int_dev_ptr);
return(IO_OK);
} else {
return(IO_ERROR_DEVICE_BUSY);
} /* Endif */
} /* Endbody */
uint_32 _core_mutex_destroy( CORE_MUTEX_PTR mutex_ptr )
{
CORE_MUTEX_COMPONENT_PTR component_ptr = _core_mutext_get_component_ptr();
SEMA4_MemMapPtr sema4_ptr;
pointer tq;
uint_32 core_num, mutex_num,i;
#if MQX_CHECK_ERRORS
if (component_ptr == NULL) {
return MQX_COMPONENT_DOES_NOT_EXIST;
}
if (mutex_ptr==NULL) {
return MQX_INVALID_POINTER;
}
if (mutex_ptr->VALID != CORE_MUTEX_VALID) {
return MQX_INVALID_POINTER;
}
#endif
mutex_num = mutex_ptr->GATE_NUM;
// figure out which device this mutex is associated with
for (i=0;i<SEMA4_NUM_DEVICES;i++) {
sema4_ptr = _bsp_get_sema4_base_address(i);
if (&sema4_ptr->GATE[mutex_num] == mutex_ptr->GATE_PTR) {
core_num = i;
break;
}
}
_int_disable();
#if MQX_CHECK_ERRORS
if (component_ptr->DEVICE[core_num].MUTEX_PTR[mutex_num] == NULL) {
_int_enable();
return MQX_COMPONENT_DOES_NOT_EXIST;
}
#endif
component_ptr->DEVICE[core_num].MUTEX_PTR[mutex_num] = NULL;
if (_psp_core_num()==0) {
component_ptr->DEVICE[core_num].SEMA4_PTR->CP0INE &= ~(1 << (SEMA4_NUM_GATES - 1 - idx[mutex_num])); //~(1 << (SEMA4_NUM_GATES-1-mutex_num));
} else {
component_ptr->DEVICE[core_num].SEMA4_PTR->CP1INE &= ~(1 << (SEMA4_NUM_GATES - 1 - idx[mutex_num])); //~(1 << (SEMA4_NUM_GATES-1-mutex_num));
}
tq = mutex_ptr->WAIT_Q;
mutex_ptr->VALID=0;
_int_enable();
if (component_ptr->DEVICE[core_num].ALLOCED & (1<<mutex_num)) {
component_ptr->DEVICE[core_num].ALLOCED &= ~(1<<mutex_num);
} else {
mutex_ptr=NULL;
}
_taskq_destroy(tq);
if (mutex_ptr) {
_mem_free(mutex_ptr);
}
return COREMUTEX_OK;
}
_mqx_int _io_serial_int_open
(
/* [IN] the file handle for the device being opened */
FILE_DEVICE_STRUCT_PTR fd_ptr,
/* [IN] the remaining portion of the name of the device */
char _PTR_ open_name_ptr,
/* [IN] the flags to be used during operation:
** echo, translation, xon/xoff
*/
char _PTR_ flags
)
{ /* Body */
IO_DEVICE_STRUCT_PTR io_dev_ptr;
IO_SERIAL_INT_DEVICE_STRUCT_PTR int_io_dev_ptr;
_mqx_uint result = MQX_OK;
_mqx_uint ioctl_val;
io_dev_ptr = fd_ptr->DEV_PTR;
int_io_dev_ptr = (pointer)io_dev_ptr->DRIVER_INIT_PTR;
if (int_io_dev_ptr->COUNT) {
/* Device is already opened */
int_io_dev_ptr->COUNT++;
fd_ptr->FLAGS = int_io_dev_ptr->FLAGS;
return(result);
} /* Endif */
int_io_dev_ptr->IN_WAITING_TASKS = _taskq_create(MQX_TASK_QUEUE_FIFO);
int_io_dev_ptr->OUT_WAITING_TASKS = _taskq_create(MQX_TASK_QUEUE_FIFO);
int_io_dev_ptr->IN_QUEUE = (pointer)_mem_alloc_system(
sizeof(CHARQ_STRUCT) - (4 * sizeof(char)) + int_io_dev_ptr->QUEUE_SIZE);
int_io_dev_ptr->OUT_QUEUE = (pointer)_mem_alloc_system(
sizeof(CHARQ_STRUCT) - (4 * sizeof(char)) + int_io_dev_ptr->QUEUE_SIZE);
#if MQX_CHECK_MEMORY_ALLOCATION_ERRORS
if ((int_io_dev_ptr->IN_QUEUE == NULL) ||
(int_io_dev_ptr->OUT_QUEUE == NULL) ||
(int_io_dev_ptr->IN_WAITING_TASKS == NULL) ||
(int_io_dev_ptr->OUT_WAITING_TASKS == NULL))
{
if (int_io_dev_ptr->IN_QUEUE != NULL){
_mem_free(int_io_dev_ptr->IN_QUEUE);
} /* Endif */
if (int_io_dev_ptr->OUT_QUEUE != NULL){
_mem_free(int_io_dev_ptr->OUT_QUEUE);
} /* Endif */
if (int_io_dev_ptr->IN_WAITING_TASKS != NULL) {
_taskq_destroy(int_io_dev_ptr->IN_WAITING_TASKS);
}/* Endif */
if (int_io_dev_ptr->OUT_WAITING_TASKS != NULL) {
_taskq_destroy(int_io_dev_ptr->OUT_WAITING_TASKS);
}/* Endif */
return(MQX_OUT_OF_MEMORY);
}/* Endif */
#endif
_mem_set_type(int_io_dev_ptr->IN_QUEUE,MEM_TYPE_IO_SERIAL_IN_QUEUE);
_mem_set_type(int_io_dev_ptr->OUT_QUEUE,MEM_TYPE_IO_SERIAL_OUT_QUEUE);
_CHARQ_INIT(int_io_dev_ptr->IN_QUEUE, int_io_dev_ptr->QUEUE_SIZE);
_CHARQ_INIT(int_io_dev_ptr->OUT_QUEUE, int_io_dev_ptr->QUEUE_SIZE);
int_io_dev_ptr->INPUT_HIGH_WATER_MARK = int_io_dev_ptr->QUEUE_SIZE -
int_io_dev_ptr->QUEUE_SIZE/8;
int_io_dev_ptr->INPUT_LOW_WATER_MARK = int_io_dev_ptr->QUEUE_SIZE/2;
int_io_dev_ptr->FLAGS = (_mqx_uint)flags;
fd_ptr->FLAGS = (_mqx_uint)flags;
#if MQX_ENABLE_LOW_POWER
_lwsem_wait (&(int_io_dev_ptr->LPM_INFO.LOCK));
#endif
result = (*int_io_dev_ptr->DEV_INIT)(int_io_dev_ptr, open_name_ptr);
#if MQX_ENABLE_LOW_POWER
_lwsem_post (&(int_io_dev_ptr->LPM_INFO.LOCK));
#endif
if (result == MQX_OK) {
#if MQX_ENABLE_LOW_POWER
_lwsem_wait (&(int_io_dev_ptr->LPM_INFO.LOCK));
#endif
result = (*int_io_dev_ptr->DEV_ENABLE_INTS)(int_io_dev_ptr->DEV_INFO_PTR);
#if MQX_ENABLE_LOW_POWER
_lwsem_post (&(int_io_dev_ptr->LPM_INFO.LOCK));
#endif
if (int_io_dev_ptr->DEV_IOCTL != NULL) {
if ((_mqx_uint)flags & IO_SERIAL_HW_FLOW_CONTROL) {
ioctl_val = IO_SERIAL_RTS;
(*int_io_dev_ptr->DEV_IOCTL)(int_io_dev_ptr->DEV_INFO_PTR, IO_IOCTL_SERIAL_SET_HW_SIGNAL, &ioctl_val);
} /* Endif */
ioctl_val = (_mqx_uint)flags;
(*int_io_dev_ptr->DEV_IOCTL)(int_io_dev_ptr->DEV_INFO_PTR, IO_IOCTL_SERIAL_SET_FLAGS, &ioctl_val);
}
if (result == MQX_OK && ((_mqx_uint)flags & IO_SERIAL_NON_BLOCKING)
&& (_mqx_uint)flags & (IO_SERIAL_TRANSLATION | IO_SERIAL_ECHO | IO_SERIAL_XON_XOFF)) {
result = MQX_INVALID_PARAMETER;
} /* Endif */
} /* Endif */
if (result != MQX_OK) {
_mem_free(int_io_dev_ptr->IN_QUEUE);
_mem_free(int_io_dev_ptr->OUT_QUEUE);
_taskq_destroy(int_io_dev_ptr->IN_WAITING_TASKS);
_taskq_destroy(int_io_dev_ptr->OUT_WAITING_TASKS);
}
int_io_dev_ptr->COUNT = 1;
return(result);
} /* Endbody */