Message ID | 1453581610-23179-12-git-send-email-hpoussin@reactos.org (mailing list archive) |
---|---|
State | New, archived |
Headers | show |
On Sat, Jan 23, 2016 at 09:40:08PM +0100, Hervé Poussineau wrote: > Signed-off-by: Hervé Poussineau <hpoussin@reactos.org> Reviewed-by: David Gibson <david@gibson.dropbear.id.au> > --- > hw/misc/macio/cuda.c | 24 ++++++++++++++++++------ > 1 file changed, 18 insertions(+), 6 deletions(-) > > diff --git a/hw/misc/macio/cuda.c b/hw/misc/macio/cuda.c > index 55e9cff..49a79fc 100644 > --- a/hw/misc/macio/cuda.c > +++ b/hw/misc/macio/cuda.c > @@ -673,6 +673,23 @@ static bool cuda_cmd_get_time(CUDAState *s, > 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[] = { > { CUDA_AUTOPOLL, "AUTOPOLL", cuda_cmd_autopoll }, > { CUDA_SET_AUTO_RATE, "SET_AUTO_RATE", cuda_cmd_set_autorate }, > @@ -684,6 +701,7 @@ static const CudaCommand handlers[] = { > { CUDA_SET_POWER_MESSAGES, "SET_POWER_MESSAGES", > cuda_cmd_set_power_message }, > { 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, > @@ -691,7 +709,6 @@ static void cuda_receive_packet(CUDAState *s, > { > uint8_t obuf[16] = { CUDA_PACKET, 0, data[0] }; > int i, out_len = 0; > - uint32_t ti; > > for (i = 0; i < ARRAY_SIZE(handlers); i++) { > const CudaCommand *desc = &handlers[i]; > @@ -718,11 +735,6 @@ static void cuda_receive_packet(CUDAState *s, > case CUDA_GET_6805_ADDR: > cuda_send_packet_to_host(s, obuf, 3); > 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: > obuf[0] = ERROR_PACKET; > obuf[1] = 0x5;
diff --git a/hw/misc/macio/cuda.c b/hw/misc/macio/cuda.c index 55e9cff..49a79fc 100644 --- a/hw/misc/macio/cuda.c +++ b/hw/misc/macio/cuda.c @@ -673,6 +673,23 @@ static bool cuda_cmd_get_time(CUDAState *s, 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[] = { { CUDA_AUTOPOLL, "AUTOPOLL", cuda_cmd_autopoll }, { CUDA_SET_AUTO_RATE, "SET_AUTO_RATE", cuda_cmd_set_autorate }, @@ -684,6 +701,7 @@ static const CudaCommand handlers[] = { { CUDA_SET_POWER_MESSAGES, "SET_POWER_MESSAGES", cuda_cmd_set_power_message }, { 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, @@ -691,7 +709,6 @@ static void cuda_receive_packet(CUDAState *s, { uint8_t obuf[16] = { CUDA_PACKET, 0, data[0] }; int i, out_len = 0; - uint32_t ti; for (i = 0; i < ARRAY_SIZE(handlers); i++) { const CudaCommand *desc = &handlers[i]; @@ -718,11 +735,6 @@ static void cuda_receive_packet(CUDAState *s, case CUDA_GET_6805_ADDR: cuda_send_packet_to_host(s, obuf, 3); 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: obuf[0] = ERROR_PACKET; obuf[1] = 0x5;
Signed-off-by: Hervé Poussineau <hpoussin@reactos.org> --- hw/misc/macio/cuda.c | 24 ++++++++++++++++++------ 1 file changed, 18 insertions(+), 6 deletions(-)