Beispiel #1
0
void
hw_serial_init (void)
{
  com_port_init (COM_PORT_1_IO);
  com_port_init (COM_PORT_2_IO);
  com_port_init (COM_PORT_3_IO);
  com_port_init (COM_PORT_4_IO);
}
Beispiel #2
0
static void com_thread_entry(void *parameter)
{
	rt_err_t ret;
	
	uint8_t payload[MAX_RECV_PACKET_SIZE - (sizeof(PACKET) - 1)];
	
	uint8_t packet_buffer[MAX_SEND_PACKET_SIZE];

	uint16_t packet_len;
	
	TEST_CMD  test_cmd;
	
	uint32_t voltage, current, ac;
	
	uint8_t test_type;
	uint8_t test_status;
	
	com_port_set_read_callback(packet_receive_callback);
	
	com_port_init();
	
	while (RT_TRUE)
	{
		/* wait for payload */
		RT_ASSERT(s_payload_queue != RT_NULL);
		ret = rt_mq_recv(s_payload_queue, payload, sizeof(payload), RT_WAITING_FOREVER);
		if (ret == RT_EOK)
		{
			/* do cmd */
			uint8_t cmd = payload[0];
			
			switch (cmd)
			{
			case CMD_CV_MODE:
				{
					PAYLOAD_CMD_CV_MODE *payload_cv_mode = (PAYLOAD_CMD_CV_MODE *)payload;
					
					TRACE("CMD_CV_MODE\n");
				
					packet_len = build_cv_mode_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}
				
					/* notify work thread */
					test_cmd.test_type = TEST_TYPE_CV_MODE;
					test_cmd.test_config.cv_mode_config.voltage_val = payload_cv_mode->voltage_val;
					
					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));
				}
				
				break;
			
			case CMD_CC_MODE:
				{
					PAYLOAD_CMD_CC_MODE *payload_cc_mode = (PAYLOAD_CMD_CC_MODE *)payload;
					
					TRACE("CMD_CC_MODE\n");
				
					packet_len = build_cc_mode_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}

					/* notify work thread */
					test_cmd.test_type = TEST_TYPE_CC_MODE;
					test_cmd.test_config.cc_mode_config.current_val = payload_cc_mode->current_val;
					
					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));					
				}
				
				break;
			
			case CMD_CR_MODE:
				{
					PAYLOAD_CMD_CR_MODE *payload_cr_mode = (PAYLOAD_CMD_CR_MODE *)payload;
					
					TRACE("CMD_CR_MODE\n");
				
					packet_len = build_cr_mode_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}
				
					/* notify work thread */
					test_cmd.test_type = TEST_TYPE_CR_MODE;
					test_cmd.test_config.cr_mode_config.resist_val = payload_cr_mode->resist_val;
					
					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));	
				}
				
				break;

			case CMD_CV_TEST:
				{
					PAYLOAD_CMD_CV_TEST *payload_cv_test = (PAYLOAD_CMD_CV_TEST *)payload;

					TRACE("CMD_CV_TEST\n");

					packet_len = build_cv_test_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}

					/* notify work thread */
					test_cmd.test_type = TEST_TYPE_CV_TEST;

					test_cmd.test_config.cv_test_config.test_category = payload_cv_test->test_category;
					test_cmd.test_config.cv_test_config.voltage_level = payload_cv_test->voltage_level;
					test_cmd.test_config.cv_test_config.voltage_val = payload_cv_test->voltage_val;
					test_cmd.test_config.cv_test_config.duration = payload_cv_test->duration;
					test_cmd.test_config.cv_test_config.ac_upper = payload_cv_test->ac_upper;
					test_cmd.test_config.cv_test_config.current_lower = payload_cv_test->current_lower;
					test_cmd.test_config.cv_test_config.current_upper = payload_cv_test->current_upper;


					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));	
				}

				break;

			case CMD_CC_TEST:
				{
					PAYLOAD_CMD_CC_TEST *payload_cc_test = (PAYLOAD_CMD_CC_TEST *)payload;

					TRACE("CMD_CC_TEST\n");

					packet_len = build_cc_test_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}

					/* notify work thread */
					test_cmd.test_type = TEST_TYPE_CC_TEST;

					test_cmd.test_config.cc_test_config.test_category = payload_cc_test->test_category;
					test_cmd.test_config.cc_test_config.voltage_level = payload_cc_test->voltage_level;
					test_cmd.test_config.cc_test_config.current_val = payload_cc_test->current_val;
					test_cmd.test_config.cc_test_config.duration = payload_cc_test->duration;
					test_cmd.test_config.cc_test_config.ac_upper = payload_cc_test->ac_upper;
					test_cmd.test_config.cc_test_config.voltage_lower = payload_cc_test->voltage_lower;
					test_cmd.test_config.cc_test_config.voltage_upper = payload_cc_test->voltage_upper;


					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));	
				}

				break;

			case CMD_CR_TEST:
				{
					PAYLOAD_CMD_CR_TEST *payload_cr_test = (PAYLOAD_CMD_CR_TEST *)payload;

					TRACE("CMD_CR_TEST\n");

					packet_len = build_cr_test_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}

					/* notify work thread */
					test_cmd.test_type = TEST_TYPE_CR_TEST;

					test_cmd.test_config.cr_test_config.test_category = payload_cr_test->test_category;
					test_cmd.test_config.cr_test_config.voltage_level = payload_cr_test->voltage_level;
					test_cmd.test_config.cr_test_config.resist_val = payload_cr_test->resist_val;
					test_cmd.test_config.cr_test_config.duration = payload_cr_test->duration;
					test_cmd.test_config.cr_test_config.ac_upper = payload_cr_test->ac_upper;
					test_cmd.test_config.cr_test_config.voltage_lower = payload_cr_test->voltage_lower;
					test_cmd.test_config.cr_test_config.voltage_upper = payload_cr_test->voltage_upper;
					test_cmd.test_config.cr_test_config.current_lower = payload_cr_test->current_lower;
					test_cmd.test_config.cr_test_config.current_upper = payload_cr_test->current_upper;


					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));	
				}

				break;

			case CMD_EMPTY_LOAD_TEST:
				{
					PAYLOAD_CMD_EMPTY_LOAD_TEST *payload_empty_load_test = (PAYLOAD_CMD_EMPTY_LOAD_TEST *)payload;

					TRACE("CMD_EMPTY_LOAD_TEST\n");

					packet_len = build_empty_load_test_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}

					/* notify work thread */
					test_cmd.test_type = TEST_TYPE_EMPTY_LOAD_TEST;
					
					test_cmd.test_config.empty_load_test_config.duration = payload_empty_load_test->duration;
					test_cmd.test_config.empty_load_test_config.ac_upper = payload_empty_load_test->ac_upper;
					test_cmd.test_config.empty_load_test_config.voltage_lower = payload_empty_load_test->voltage_lower;
					test_cmd.test_config.empty_load_test_config.voltage_upper = payload_empty_load_test->voltage_upper;


					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));	
				}

				break;

			case CMD_OVER_CURRENT_TEST:
				{
					PAYLOAD_CMD_OVER_CURRENT_TEST *payload_over_current_test = (PAYLOAD_CMD_OVER_CURRENT_TEST *)payload;

					TRACE("CMD_OVER_CURRENT_TEST\n");

					packet_len = build_over_current_test_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}

					/* notify work thread */
					test_cmd.test_type = TEST_TYPE_OVER_CURRENT_TEST;

					test_cmd.test_config.over_current_test_config.test_category = payload_over_current_test->test_category;
					test_cmd.test_config.over_current_test_config.voltage_level = payload_over_current_test->voltage_level;
					test_cmd.test_config.over_current_test_config.interval = payload_over_current_test->interval;
					test_cmd.test_config.over_current_test_config.ac_upper = payload_over_current_test->ac_upper;
					test_cmd.test_config.over_current_test_config.current_upper = payload_over_current_test->current_upper;

					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));	
				}

				break;

			case CMD_SHORT_TEST:
				{
					PAYLOAD_CMD_SHORT_TEST *payload_short_test = (PAYLOAD_CMD_SHORT_TEST *)payload;

					TRACE("CMD_SHORT_TEST\n");

					packet_len = build_short_test_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}

					/* notify work thread */
					test_cmd.test_type = TEST_TYPE_SHORT_TEST;

					test_cmd.test_config.short_test_config.test_category = payload_short_test->test_category;
					test_cmd.test_config.short_test_config.voltage_level = payload_short_test->voltage_level;
					test_cmd.test_config.short_test_config.duration = payload_short_test->duration;
					test_cmd.test_config.short_test_config.ac_upper = payload_short_test->ac_upper;
					test_cmd.test_config.short_test_config.current_upper = payload_short_test->current_upper;

					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));	
				}

				break;

			case CMD_DISCHARGE_TEST:
				{
					PAYLOAD_CMD_DISCHARGE_TEST *payload_discharge_test = (PAYLOAD_CMD_DISCHARGE_TEST *)payload;

					TRACE("CMD_DISCHARGE_TEST\n");

					packet_len = build_discharge_test_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}

					/* notify work thread */
					test_cmd.test_type = TEST_TYPE_DISCHARGE_TEST;
					
					test_cmd.test_config.discharge_test_config.duration = payload_discharge_test->duration;
					test_cmd.test_config.discharge_test_config.current_val = payload_discharge_test->current_val;

					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));	
				}

				break;
				
			case CMD_STOP:
				{
					TRACE("CMD_STOP\n");
				
					packet_len = build_stop_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), RESULT_OK);
					if (packet_len != PACKET_TOO_LONG)
					{
						/* reply */
						com_port_write(packet_buffer, packet_len);
					}
				
					/* notify work thread */
					test_cmd.test_type     = TEST_TYPE_NONE;
					
					RT_ASSERT(g_test_cmd_queue != RT_NULL);
					rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));
				}
				
				break;
				
			case CMD_POLL:
				/* get value */
				RT_ASSERT(g_sem_test_content != RT_NULL);
				rt_sem_take(g_sem_test_content, RT_WAITING_FOREVER);

				if (g_test_content.test_type == TEST_TYPE_OVER_CURRENT_TEST
					&& g_test_content.test_status == TEST_STATUS_NORMAL)
				{
					current = g_over_current_test_result.over_current_test_current;

					voltage = g_over_current_test_result.over_current_test_voltage;

					if (g_over_current_test_result.over_current_test_ac > s_ac_offset_value)
					{
						ac = g_over_current_test_result.over_current_test_ac - s_ac_offset_value;
					}
					else
					{
						ac = 0;
					}
				}
				else
				{
					current = g_test_content.current;

					voltage = g_test_content.voltage;

					if (g_test_content.ac_current > s_ac_offset_value)
					{
						ac = g_test_content.ac_current - s_ac_offset_value;
					}
					else
					{
						ac = 0;
					}
				}
				
				test_type   = g_test_content.test_type;
				test_status = g_test_content.test_status;
				rt_sem_release(g_sem_test_content);
				
				packet_len = build_poll_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), test_type, test_status, ac, voltage, current);
				if (packet_len != PACKET_TOO_LONG)
				{
					/* reply */
					com_port_write(packet_buffer, packet_len);
				}
				
				break;

			case CMD_SET_ADJUST_VALUE:
				{
					PAYLOAD_CMD_SET_ADJUST_VALUE *payload_set_adjust_value = (PAYLOAD_CMD_SET_ADJUST_VALUE *)payload;

					ADJUST_PARAMETER.measure_voltage = payload_set_adjust_value->measure_voltage;
					ADJUST_PARAMETER.actual_voltage  = payload_set_adjust_value->actual_voltage;
					ADJUST_PARAMETER.measure_current = payload_set_adjust_value->measure_current;
					ADJUST_PARAMETER.actual_current  = payload_set_adjust_value->actual_current;
					
					save_parameter();
				}
				
				break;

			case CMD_GET_ADJUST_VALUE:
				TRACE("get adjust\n");
				packet_len = build_get_adjust_value_cmd_ret_packet(packet_buffer, sizeof(packet_buffer), ADJUST_PARAMETER.measure_voltage, ADJUST_PARAMETER.actual_voltage, 
																		ADJUST_PARAMETER.measure_current, ADJUST_PARAMETER.actual_current);
				if (packet_len != PACKET_TOO_LONG)
				{
					/* reply */
					com_port_write(packet_buffer, packet_len);

					TRACE("get adjust value ret:measure voltage:%d,actual voltage:%d,measure current:%d,actual current:%d\n", 
							ADJUST_PARAMETER.measure_voltage, ADJUST_PARAMETER.actual_voltage, ADJUST_PARAMETER.measure_current, ADJUST_PARAMETER.actual_current);
				}

				RT_ASSERT(g_sem_test_content != RT_NULL);
				
				rt_sem_take(g_sem_test_content, RT_WAITING_FOREVER);
				s_ac_offset_value = g_test_content.ac_current;
				rt_sem_release(g_sem_test_content);

				/* notify work thread */
				test_cmd.test_type     = TEST_TYPE_NONE;
					
				RT_ASSERT(g_test_cmd_queue != RT_NULL);
				rt_mq_send(g_test_cmd_queue, &test_cmd, sizeof(test_cmd));
				
				break;
				
			default:
				
				break;
			}
		}
	}
}