paul@0 | 1 | /* |
paul@0 | 2 | * JZ4780 CPM server. |
paul@0 | 3 | * |
paul@0 | 4 | * Copyright (C) 2018 Paul Boddie <paul@boddie.org.uk> |
paul@0 | 5 | * |
paul@0 | 6 | * This program is free software; you can redistribute it and/or |
paul@0 | 7 | * modify it under the terms of the GNU General Public License as |
paul@0 | 8 | * published by the Free Software Foundation; either version 2 of |
paul@0 | 9 | * the License, or (at your option) any later version. |
paul@0 | 10 | * |
paul@0 | 11 | * This program is distributed in the hope that it will be useful, |
paul@0 | 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
paul@0 | 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
paul@0 | 14 | * GNU General Public License for more details. |
paul@0 | 15 | * |
paul@0 | 16 | * You should have received a copy of the GNU General Public License |
paul@0 | 17 | * along with this program; if not, write to the Free Software |
paul@0 | 18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, |
paul@0 | 19 | * Boston, MA 02110-1301, USA |
paul@0 | 20 | */ |
paul@0 | 21 | |
paul@0 | 22 | #include <l4/devices/cpm-jz4780.h> |
paul@0 | 23 | #include <l4/devices/memory.h> |
paul@0 | 24 | #include "cpm-server.h" |
paul@0 | 25 | |
paul@0 | 26 | #include <l4/re/dataspace> |
paul@0 | 27 | #include <l4/re/env> |
paul@0 | 28 | #include <l4/re/util/object_registry> |
paul@0 | 29 | |
paul@0 | 30 | #include <l4/sys/types.h> |
paul@0 | 31 | |
paul@0 | 32 | // Virtual addresses for the CPM and LCD register blocks. |
paul@0 | 33 | |
paul@0 | 34 | static l4_addr_t cpm_virt_base = 0, cpm_virt_base_end = 0; |
paul@0 | 35 | |
paul@0 | 36 | |
paul@0 | 37 | |
paul@0 | 38 | // Access to peripheral memory. |
paul@0 | 39 | |
paul@0 | 40 | static int setup_memory() |
paul@0 | 41 | { |
paul@0 | 42 | if (get_memory("jz4780-cpm", &cpm_virt_base, &cpm_virt_base_end)) |
paul@0 | 43 | return 1; |
paul@0 | 44 | |
paul@0 | 45 | return 0; |
paul@0 | 46 | } |
paul@0 | 47 | |
paul@0 | 48 | |
paul@0 | 49 | |
paul@0 | 50 | static L4Re::Util::Registry_server<> server; |
paul@0 | 51 | |
paul@0 | 52 | |
paul@0 | 53 | |
paul@0 | 54 | /* Main program. */ |
paul@0 | 55 | |
paul@0 | 56 | int main(void) |
paul@0 | 57 | { |
paul@0 | 58 | if (setup_memory()) return 1; |
paul@0 | 59 | |
paul@0 | 60 | /* Initialise the CPM abstraction. */ |
paul@0 | 61 | |
paul@0 | 62 | Cpm_jz4780_chip cpm_device(cpm_virt_base, 48000000, 32768); |
paul@0 | 63 | |
paul@0 | 64 | /* Initialise and register a server object. */ |
paul@0 | 65 | |
paul@0 | 66 | Cpm_server server_obj(&cpm_device); |
paul@0 | 67 | server.registry()->register_obj(&server_obj, "cpm"); |
paul@0 | 68 | |
paul@0 | 69 | /* Enter the IPC server loop. */ |
paul@0 | 70 | |
paul@0 | 71 | server.loop(); |
paul@0 | 72 | return 0; |
paul@0 | 73 | } |