1 /* 2 * Common CPM server functionality. 3 * 4 * Copyright (C) 2018, 2020 Paul Boddie <paul@boddie.org.uk> 5 * 6 * This program is free software; you can redistribute it and/or 7 * modify it under the terms of the GNU General Public License as 8 * published by the Free Software Foundation; either version 2 of 9 * the License, or (at your option) any later version. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 * 16 * You should have received a copy of the GNU General Public License 17 * along with this program; if not, write to the Free Software 18 * Foundation, Inc., 51 Franklin Street, Fifth Floor, 19 * Boston, MA 02110-1301, USA 20 */ 21 22 #include "cpm-client.h" 23 #include "cpm-server.h" 24 #include "cpm-ops.h" 25 26 #include <l4/cxx/ipc_server> 27 #include <l4/re/env> 28 #include <l4/sys/typeinfo_svr> 29 #include <l4/util/util.h> 30 31 /* Handle invocations. */ 32 33 int 34 Cpm_server::dispatch(l4_umword_t obj, L4::Ipc::Iostream &ios) 35 { 36 l4_msgtag_t tag; 37 38 (void) obj; 39 ios >> tag; 40 41 switch (tag.label()) 42 { 43 case L4::Meta::Protocol: 44 return L4::Util::handle_meta_request<Cpm_device_interface>(ios); 45 46 case Cpm_op_get_lcd_pixel_frequency: 47 ios << _chip->get_lcd_pixel_frequency(); 48 return L4_EOK; 49 50 case Cpm_op_set_hdmi_frequency: 51 uint32_t frequency; 52 ios >> frequency; 53 _chip->set_hdmi_frequency(frequency); 54 return L4_EOK; 55 56 case Cpm_op_start_hdmi: 57 _chip->start_hdmi(); 58 return L4_EOK; 59 60 case Cpm_op_stop_hdmi: 61 _chip->stop_hdmi(); 62 return L4_EOK; 63 64 case Cpm_op_set_lcd_frequencies: 65 uint32_t pclk; 66 int multiplier; 67 ios >> pclk; 68 ios >> multiplier; 69 _chip->set_lcd_frequencies(pclk, multiplier); 70 return L4_EOK; 71 72 case Cpm_op_start_lcd: 73 _chip->start_lcd(); 74 return L4_EOK; 75 76 case Cpm_op_stop_lcd: 77 _chip->stop_lcd(); 78 return L4_EOK; 79 80 case Cpm_op_update_output_frequency: 81 _chip->update_output_frequency(); 82 return L4_EOK; 83 84 default: 85 return -L4_EBADPROTO; 86 } 87 }