cuda: port SET_TIME command to new framework

Reviewed-by: David Gibson <david@gibson.dropbear.id.au>
Signed-off-by: Hervé Poussineau <hpoussin@reactos.org>
Reviewed-by: Mark Cave-Ayland <mark.cave-ayland@ilande.co.uk>
Signed-off-by: David Gibson <david@gibson.dropbear.id.au>
This commit is contained in:
Hervé Poussineau 2016-02-07 21:34:14 +01:00 committed by David Gibson
parent 547a4d1969
commit e647317892

View File

@ -674,6 +674,23 @@ static bool cuda_cmd_get_time(CUDAState *s,
return true; return true;
} }
static bool cuda_cmd_set_time(CUDAState *s,
const uint8_t *in_data, int in_len,
uint8_t *out_data, int *out_len)
{
uint32_t ti;
if (in_len != 4) {
return false;
}
ti = (((uint32_t)in_data[1]) << 24) + (((uint32_t)in_data[2]) << 16)
+ (((uint32_t)in_data[3]) << 8) + in_data[4];
s->tick_offset = ti - (qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL)
/ get_ticks_per_sec());
return true;
}
static const CudaCommand handlers[] = { static const CudaCommand handlers[] = {
{ CUDA_AUTOPOLL, "AUTOPOLL", cuda_cmd_autopoll }, { CUDA_AUTOPOLL, "AUTOPOLL", cuda_cmd_autopoll },
{ CUDA_SET_AUTO_RATE, "SET_AUTO_RATE", cuda_cmd_set_autorate }, { CUDA_SET_AUTO_RATE, "SET_AUTO_RATE", cuda_cmd_set_autorate },
@ -685,6 +702,7 @@ static const CudaCommand handlers[] = {
{ CUDA_SET_POWER_MESSAGES, "SET_POWER_MESSAGES", { CUDA_SET_POWER_MESSAGES, "SET_POWER_MESSAGES",
cuda_cmd_set_power_message }, cuda_cmd_set_power_message },
{ CUDA_GET_TIME, "GET_TIME", cuda_cmd_get_time }, { CUDA_GET_TIME, "GET_TIME", cuda_cmd_get_time },
{ CUDA_SET_TIME, "SET_TIME", cuda_cmd_set_time },
}; };
static void cuda_receive_packet(CUDAState *s, static void cuda_receive_packet(CUDAState *s,
@ -692,7 +710,6 @@ static void cuda_receive_packet(CUDAState *s,
{ {
uint8_t obuf[16] = { CUDA_PACKET, 0, data[0] }; uint8_t obuf[16] = { CUDA_PACKET, 0, data[0] };
int i, out_len = 0; int i, out_len = 0;
uint32_t ti;
for (i = 0; i < ARRAY_SIZE(handlers); i++) { for (i = 0; i < ARRAY_SIZE(handlers); i++) {
const CudaCommand *desc = &handlers[i]; const CudaCommand *desc = &handlers[i];
@ -719,11 +736,6 @@ static void cuda_receive_packet(CUDAState *s,
case CUDA_GET_6805_ADDR: case CUDA_GET_6805_ADDR:
cuda_send_packet_to_host(s, obuf, 3); cuda_send_packet_to_host(s, obuf, 3);
return; return;
case CUDA_SET_TIME:
ti = (((uint32_t)data[1]) << 24) + (((uint32_t)data[2]) << 16) + (((uint32_t)data[3]) << 8) + data[4];
s->tick_offset = ti - (qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) / get_ticks_per_sec());
cuda_send_packet_to_host(s, obuf, 3);
return;
case CUDA_COMBINED_FORMAT_IIC: case CUDA_COMBINED_FORMAT_IIC:
obuf[0] = ERROR_PACKET; obuf[0] = ERROR_PACKET;
obuf[1] = 0x5; obuf[1] = 0x5;