mirror of
https://gitea.osmocom.org/cellular-infrastructure/osmo-trx.git
synced 2025-11-04 14:13:29 +00:00
Compare commits
18 Commits
mstrx
...
hoernchen/
| Author | SHA1 | Date | |
|---|---|---|---|
|
a670630cfe | ||
|
|
76c8846df9 | ||
|
|
904959f860 | ||
|
|
30796c8cbb | ||
|
|
5002af94c1 | ||
|
|
ec1f46e88e | ||
|
|
57ece5a46f | ||
|
|
dac7708ff3 | ||
|
|
90b0b8696d | ||
|
|
2120eb1e0a | ||
|
|
6d3359e37b | ||
|
|
ac85758763 | ||
|
|
a1d2b1f822 | ||
|
|
0f839a1a49 | ||
|
|
ef73893222 | ||
|
|
0bf8882fb6 | ||
|
87a77440f2 | ||
|
|
87d6f3c8e1 |
521
.clang-format
Normal file
521
.clang-format
Normal file
@@ -0,0 +1,521 @@
|
|||||||
|
# SPDX-License-Identifier: GPL-2.0
|
||||||
|
#
|
||||||
|
# clang-format configuration file. Intended for clang-format >= 4.
|
||||||
|
#
|
||||||
|
# For more information, see:
|
||||||
|
#
|
||||||
|
# Documentation/process/clang-format.rst
|
||||||
|
# https://clang.llvm.org/docs/ClangFormat.html
|
||||||
|
# https://clang.llvm.org/docs/ClangFormatStyleOptions.html
|
||||||
|
#
|
||||||
|
---
|
||||||
|
AccessModifierOffset: -4
|
||||||
|
AlignAfterOpenBracket: Align
|
||||||
|
AlignConsecutiveAssignments: false
|
||||||
|
AlignConsecutiveDeclarations: false
|
||||||
|
#AlignEscapedNewlines: Left # Unknown to clang-format-4.0
|
||||||
|
AlignOperands: true
|
||||||
|
AlignTrailingComments: false
|
||||||
|
AllowAllParametersOfDeclarationOnNextLine: false
|
||||||
|
AllowShortBlocksOnASingleLine: false
|
||||||
|
AllowShortCaseLabelsOnASingleLine: false
|
||||||
|
AllowShortFunctionsOnASingleLine: None
|
||||||
|
AllowShortIfStatementsOnASingleLine: false
|
||||||
|
AllowShortLoopsOnASingleLine: false
|
||||||
|
AlwaysBreakAfterDefinitionReturnType: None
|
||||||
|
AlwaysBreakAfterReturnType: None
|
||||||
|
AlwaysBreakBeforeMultilineStrings: false
|
||||||
|
AlwaysBreakTemplateDeclarations: false
|
||||||
|
BinPackArguments: true
|
||||||
|
BinPackParameters: true
|
||||||
|
BraceWrapping:
|
||||||
|
AfterClass: false
|
||||||
|
AfterControlStatement: false
|
||||||
|
AfterEnum: false
|
||||||
|
AfterFunction: true
|
||||||
|
AfterNamespace: true
|
||||||
|
AfterObjCDeclaration: false
|
||||||
|
AfterStruct: false
|
||||||
|
AfterUnion: false
|
||||||
|
#AfterExternBlock: false # Unknown to clang-format-5.0
|
||||||
|
BeforeCatch: false
|
||||||
|
BeforeElse: false
|
||||||
|
IndentBraces: false
|
||||||
|
#SplitEmptyFunction: true # Unknown to clang-format-4.0
|
||||||
|
#SplitEmptyRecord: true # Unknown to clang-format-4.0
|
||||||
|
#SplitEmptyNamespace: true # Unknown to clang-format-4.0
|
||||||
|
BreakBeforeBinaryOperators: None
|
||||||
|
BreakBeforeBraces: Custom
|
||||||
|
#BreakBeforeInheritanceComma: false # Unknown to clang-format-4.0
|
||||||
|
BreakBeforeTernaryOperators: false
|
||||||
|
BreakConstructorInitializersBeforeComma: false
|
||||||
|
#BreakConstructorInitializers: BeforeComma # Unknown to clang-format-4.0
|
||||||
|
BreakAfterJavaFieldAnnotations: false
|
||||||
|
BreakStringLiterals: false
|
||||||
|
ColumnLimit: 120
|
||||||
|
CommentPragmas: '^ IWYU pragma:'
|
||||||
|
#CompactNamespaces: false # Unknown to clang-format-4.0
|
||||||
|
ConstructorInitializerAllOnOneLineOrOnePerLine: false
|
||||||
|
ConstructorInitializerIndentWidth: 8
|
||||||
|
ContinuationIndentWidth: 8
|
||||||
|
Cpp11BracedListStyle: false
|
||||||
|
DerivePointerAlignment: false
|
||||||
|
DisableFormat: false
|
||||||
|
ExperimentalAutoDetectBinPacking: false
|
||||||
|
#FixNamespaceComments: false # Unknown to clang-format-4.0
|
||||||
|
|
||||||
|
# Taken from:
|
||||||
|
# git grep -h '^#define [^[:space:]]*for_each[^[:space:]]*(' include/ \
|
||||||
|
# | sed "s,^#define \([^[:space:]]*for_each[^[:space:]]*\)(.*$, - '\1'," \
|
||||||
|
# | sort | uniq
|
||||||
|
ForEachMacros:
|
||||||
|
- 'apei_estatus_for_each_section'
|
||||||
|
- 'ata_for_each_dev'
|
||||||
|
- 'ata_for_each_link'
|
||||||
|
- '__ata_qc_for_each'
|
||||||
|
- 'ata_qc_for_each'
|
||||||
|
- 'ata_qc_for_each_raw'
|
||||||
|
- 'ata_qc_for_each_with_internal'
|
||||||
|
- 'ax25_for_each'
|
||||||
|
- 'ax25_uid_for_each'
|
||||||
|
- '__bio_for_each_bvec'
|
||||||
|
- 'bio_for_each_bvec'
|
||||||
|
- 'bio_for_each_integrity_vec'
|
||||||
|
- '__bio_for_each_segment'
|
||||||
|
- 'bio_for_each_segment'
|
||||||
|
- 'bio_for_each_segment_all'
|
||||||
|
- 'bio_list_for_each'
|
||||||
|
- 'bip_for_each_vec'
|
||||||
|
- 'bitmap_for_each_clear_region'
|
||||||
|
- 'bitmap_for_each_set_region'
|
||||||
|
- 'blkg_for_each_descendant_post'
|
||||||
|
- 'blkg_for_each_descendant_pre'
|
||||||
|
- 'blk_queue_for_each_rl'
|
||||||
|
- 'bond_for_each_slave'
|
||||||
|
- 'bond_for_each_slave_rcu'
|
||||||
|
- 'bpf_for_each_spilled_reg'
|
||||||
|
- 'btree_for_each_safe128'
|
||||||
|
- 'btree_for_each_safe32'
|
||||||
|
- 'btree_for_each_safe64'
|
||||||
|
- 'btree_for_each_safel'
|
||||||
|
- 'card_for_each_dev'
|
||||||
|
- 'cgroup_taskset_for_each'
|
||||||
|
- 'cgroup_taskset_for_each_leader'
|
||||||
|
- 'cpufreq_for_each_entry'
|
||||||
|
- 'cpufreq_for_each_entry_idx'
|
||||||
|
- 'cpufreq_for_each_valid_entry'
|
||||||
|
- 'cpufreq_for_each_valid_entry_idx'
|
||||||
|
- 'css_for_each_child'
|
||||||
|
- 'css_for_each_descendant_post'
|
||||||
|
- 'css_for_each_descendant_pre'
|
||||||
|
- 'device_for_each_child_node'
|
||||||
|
- 'dma_fence_chain_for_each'
|
||||||
|
- 'drm_atomic_crtc_for_each_plane'
|
||||||
|
- 'drm_atomic_crtc_state_for_each_plane'
|
||||||
|
- 'drm_atomic_crtc_state_for_each_plane_state'
|
||||||
|
- 'drm_atomic_for_each_plane_damage'
|
||||||
|
- 'drm_client_for_each_connector_iter'
|
||||||
|
- 'drm_client_for_each_modeset'
|
||||||
|
- 'drm_connector_for_each_possible_encoder'
|
||||||
|
- 'drm_for_each_bridge_in_chain'
|
||||||
|
- 'drm_for_each_connector_iter'
|
||||||
|
- 'drm_for_each_crtc'
|
||||||
|
- 'drm_for_each_encoder'
|
||||||
|
- 'drm_for_each_encoder_mask'
|
||||||
|
- 'drm_for_each_fb'
|
||||||
|
- 'drm_for_each_legacy_plane'
|
||||||
|
- 'drm_for_each_plane'
|
||||||
|
- 'drm_for_each_plane_mask'
|
||||||
|
- 'drm_for_each_privobj'
|
||||||
|
- 'drm_mm_for_each_hole'
|
||||||
|
- 'drm_mm_for_each_node'
|
||||||
|
- 'drm_mm_for_each_node_in_range'
|
||||||
|
- 'drm_mm_for_each_node_safe'
|
||||||
|
- 'flow_action_for_each'
|
||||||
|
- 'for_each_active_dev_scope'
|
||||||
|
- 'for_each_active_drhd_unit'
|
||||||
|
- 'for_each_active_iommu'
|
||||||
|
- 'for_each_available_child_of_node'
|
||||||
|
- 'for_each_bio'
|
||||||
|
- 'for_each_board_func_rsrc'
|
||||||
|
- 'for_each_bvec'
|
||||||
|
- 'for_each_card_auxs'
|
||||||
|
- 'for_each_card_auxs_safe'
|
||||||
|
- 'for_each_card_components'
|
||||||
|
- 'for_each_card_pre_auxs'
|
||||||
|
- 'for_each_card_prelinks'
|
||||||
|
- 'for_each_card_rtds'
|
||||||
|
- 'for_each_card_rtds_safe'
|
||||||
|
- 'for_each_cgroup_storage_type'
|
||||||
|
- 'for_each_child_of_node'
|
||||||
|
- 'for_each_clear_bit'
|
||||||
|
- 'for_each_clear_bit_from'
|
||||||
|
- 'for_each_cmsghdr'
|
||||||
|
- 'for_each_compatible_node'
|
||||||
|
- 'for_each_component_dais'
|
||||||
|
- 'for_each_component_dais_safe'
|
||||||
|
- 'for_each_comp_order'
|
||||||
|
- 'for_each_console'
|
||||||
|
- 'for_each_cpu'
|
||||||
|
- 'for_each_cpu_and'
|
||||||
|
- 'for_each_cpu_not'
|
||||||
|
- 'for_each_cpu_wrap'
|
||||||
|
- 'for_each_dev_addr'
|
||||||
|
- 'for_each_dev_scope'
|
||||||
|
- 'for_each_displayid_db'
|
||||||
|
- 'for_each_dma_cap_mask'
|
||||||
|
- 'for_each_dpcm_be'
|
||||||
|
- 'for_each_dpcm_be_rollback'
|
||||||
|
- 'for_each_dpcm_be_safe'
|
||||||
|
- 'for_each_dpcm_fe'
|
||||||
|
- 'for_each_drhd_unit'
|
||||||
|
- 'for_each_dss_dev'
|
||||||
|
- 'for_each_efi_handle'
|
||||||
|
- 'for_each_efi_memory_desc'
|
||||||
|
- 'for_each_efi_memory_desc_in_map'
|
||||||
|
- 'for_each_element'
|
||||||
|
- 'for_each_element_extid'
|
||||||
|
- 'for_each_element_id'
|
||||||
|
- 'for_each_endpoint_of_node'
|
||||||
|
- 'for_each_evictable_lru'
|
||||||
|
- 'for_each_fib6_node_rt_rcu'
|
||||||
|
- 'for_each_fib6_walker_rt'
|
||||||
|
- 'for_each_free_mem_pfn_range_in_zone'
|
||||||
|
- 'for_each_free_mem_pfn_range_in_zone_from'
|
||||||
|
- 'for_each_free_mem_range'
|
||||||
|
- 'for_each_free_mem_range_reverse'
|
||||||
|
- 'for_each_func_rsrc'
|
||||||
|
- 'for_each_hstate'
|
||||||
|
- 'for_each_if'
|
||||||
|
- 'for_each_iommu'
|
||||||
|
- 'for_each_ip_tunnel_rcu'
|
||||||
|
- 'for_each_irq_nr'
|
||||||
|
- 'for_each_link_codecs'
|
||||||
|
- 'for_each_link_platforms'
|
||||||
|
- 'for_each_lru'
|
||||||
|
- 'for_each_matching_node'
|
||||||
|
- 'for_each_matching_node_and_match'
|
||||||
|
- 'for_each_member'
|
||||||
|
- 'for_each_memblock'
|
||||||
|
- 'for_each_memblock_type'
|
||||||
|
- 'for_each_memcg_cache_index'
|
||||||
|
- 'for_each_mem_pfn_range'
|
||||||
|
- 'for_each_mem_range'
|
||||||
|
- 'for_each_mem_range_rev'
|
||||||
|
- 'for_each_migratetype_order'
|
||||||
|
- 'for_each_msi_entry'
|
||||||
|
- 'for_each_msi_entry_safe'
|
||||||
|
- 'for_each_net'
|
||||||
|
- 'for_each_net_continue_reverse'
|
||||||
|
- 'for_each_netdev'
|
||||||
|
- 'for_each_netdev_continue'
|
||||||
|
- 'for_each_netdev_continue_rcu'
|
||||||
|
- 'for_each_netdev_continue_reverse'
|
||||||
|
- 'for_each_netdev_feature'
|
||||||
|
- 'for_each_netdev_in_bond_rcu'
|
||||||
|
- 'for_each_netdev_rcu'
|
||||||
|
- 'for_each_netdev_reverse'
|
||||||
|
- 'for_each_netdev_safe'
|
||||||
|
- 'for_each_net_rcu'
|
||||||
|
- 'for_each_new_connector_in_state'
|
||||||
|
- 'for_each_new_crtc_in_state'
|
||||||
|
- 'for_each_new_mst_mgr_in_state'
|
||||||
|
- 'for_each_new_plane_in_state'
|
||||||
|
- 'for_each_new_private_obj_in_state'
|
||||||
|
- 'for_each_node'
|
||||||
|
- 'for_each_node_by_name'
|
||||||
|
- 'for_each_node_by_type'
|
||||||
|
- 'for_each_node_mask'
|
||||||
|
- 'for_each_node_state'
|
||||||
|
- 'for_each_node_with_cpus'
|
||||||
|
- 'for_each_node_with_property'
|
||||||
|
- 'for_each_of_allnodes'
|
||||||
|
- 'for_each_of_allnodes_from'
|
||||||
|
- 'for_each_of_cpu_node'
|
||||||
|
- 'for_each_of_pci_range'
|
||||||
|
- 'for_each_old_connector_in_state'
|
||||||
|
- 'for_each_old_crtc_in_state'
|
||||||
|
- 'for_each_old_mst_mgr_in_state'
|
||||||
|
- 'for_each_oldnew_connector_in_state'
|
||||||
|
- 'for_each_oldnew_crtc_in_state'
|
||||||
|
- 'for_each_oldnew_mst_mgr_in_state'
|
||||||
|
- 'for_each_oldnew_plane_in_state'
|
||||||
|
- 'for_each_oldnew_plane_in_state_reverse'
|
||||||
|
- 'for_each_oldnew_private_obj_in_state'
|
||||||
|
- 'for_each_old_plane_in_state'
|
||||||
|
- 'for_each_old_private_obj_in_state'
|
||||||
|
- 'for_each_online_cpu'
|
||||||
|
- 'for_each_online_node'
|
||||||
|
- 'for_each_online_pgdat'
|
||||||
|
- 'for_each_pci_bridge'
|
||||||
|
- 'for_each_pci_dev'
|
||||||
|
- 'for_each_pci_msi_entry'
|
||||||
|
- 'for_each_populated_zone'
|
||||||
|
- 'for_each_possible_cpu'
|
||||||
|
- 'for_each_present_cpu'
|
||||||
|
- 'for_each_prime_number'
|
||||||
|
- 'for_each_prime_number_from'
|
||||||
|
- 'for_each_process'
|
||||||
|
- 'for_each_process_thread'
|
||||||
|
- 'for_each_property_of_node'
|
||||||
|
- 'for_each_registered_fb'
|
||||||
|
- 'for_each_reserved_mem_region'
|
||||||
|
- 'for_each_rtd_codec_dai'
|
||||||
|
- 'for_each_rtd_codec_dai_rollback'
|
||||||
|
- 'for_each_rtd_components'
|
||||||
|
- 'for_each_set_bit'
|
||||||
|
- 'for_each_set_bit_from'
|
||||||
|
- 'for_each_set_clump8'
|
||||||
|
- 'for_each_sg'
|
||||||
|
- 'for_each_sg_dma_page'
|
||||||
|
- 'for_each_sg_page'
|
||||||
|
- 'for_each_sibling_event'
|
||||||
|
- 'for_each_subelement'
|
||||||
|
- 'for_each_subelement_extid'
|
||||||
|
- 'for_each_subelement_id'
|
||||||
|
- '__for_each_thread'
|
||||||
|
- 'for_each_thread'
|
||||||
|
- 'for_each_wakeup_source'
|
||||||
|
- 'for_each_zone'
|
||||||
|
- 'for_each_zone_zonelist'
|
||||||
|
- 'for_each_zone_zonelist_nodemask'
|
||||||
|
- 'fwnode_for_each_available_child_node'
|
||||||
|
- 'fwnode_for_each_child_node'
|
||||||
|
- 'fwnode_graph_for_each_endpoint'
|
||||||
|
- 'gadget_for_each_ep'
|
||||||
|
- 'genradix_for_each'
|
||||||
|
- 'genradix_for_each_from'
|
||||||
|
- 'hash_for_each'
|
||||||
|
- 'hash_for_each_possible'
|
||||||
|
- 'hash_for_each_possible_rcu'
|
||||||
|
- 'hash_for_each_possible_rcu_notrace'
|
||||||
|
- 'hash_for_each_possible_safe'
|
||||||
|
- 'hash_for_each_rcu'
|
||||||
|
- 'hash_for_each_safe'
|
||||||
|
- 'hctx_for_each_ctx'
|
||||||
|
- 'hlist_bl_for_each_entry'
|
||||||
|
- 'hlist_bl_for_each_entry_rcu'
|
||||||
|
- 'hlist_bl_for_each_entry_safe'
|
||||||
|
- 'hlist_for_each'
|
||||||
|
- 'hlist_for_each_entry'
|
||||||
|
- 'hlist_for_each_entry_continue'
|
||||||
|
- 'hlist_for_each_entry_continue_rcu'
|
||||||
|
- 'hlist_for_each_entry_continue_rcu_bh'
|
||||||
|
- 'hlist_for_each_entry_from'
|
||||||
|
- 'hlist_for_each_entry_from_rcu'
|
||||||
|
- 'hlist_for_each_entry_rcu'
|
||||||
|
- 'hlist_for_each_entry_rcu_bh'
|
||||||
|
- 'hlist_for_each_entry_rcu_notrace'
|
||||||
|
- 'hlist_for_each_entry_safe'
|
||||||
|
- '__hlist_for_each_rcu'
|
||||||
|
- 'hlist_for_each_safe'
|
||||||
|
- 'hlist_nulls_for_each_entry'
|
||||||
|
- 'hlist_nulls_for_each_entry_from'
|
||||||
|
- 'hlist_nulls_for_each_entry_rcu'
|
||||||
|
- 'hlist_nulls_for_each_entry_safe'
|
||||||
|
- 'i3c_bus_for_each_i2cdev'
|
||||||
|
- 'i3c_bus_for_each_i3cdev'
|
||||||
|
- 'ide_host_for_each_port'
|
||||||
|
- 'ide_port_for_each_dev'
|
||||||
|
- 'ide_port_for_each_present_dev'
|
||||||
|
- 'idr_for_each_entry'
|
||||||
|
- 'idr_for_each_entry_continue'
|
||||||
|
- 'idr_for_each_entry_continue_ul'
|
||||||
|
- 'idr_for_each_entry_ul'
|
||||||
|
- 'in_dev_for_each_ifa_rcu'
|
||||||
|
- 'in_dev_for_each_ifa_rtnl'
|
||||||
|
- 'inet_bind_bucket_for_each'
|
||||||
|
- 'inet_lhash2_for_each_icsk_rcu'
|
||||||
|
- 'key_for_each'
|
||||||
|
- 'key_for_each_safe'
|
||||||
|
- 'klp_for_each_func'
|
||||||
|
- 'klp_for_each_func_safe'
|
||||||
|
- 'klp_for_each_func_static'
|
||||||
|
- 'klp_for_each_object'
|
||||||
|
- 'klp_for_each_object_safe'
|
||||||
|
- 'klp_for_each_object_static'
|
||||||
|
- 'kvm_for_each_memslot'
|
||||||
|
- 'kvm_for_each_vcpu'
|
||||||
|
- 'list_for_each'
|
||||||
|
- 'list_for_each_codec'
|
||||||
|
- 'list_for_each_codec_safe'
|
||||||
|
- 'list_for_each_continue'
|
||||||
|
- 'list_for_each_entry'
|
||||||
|
- 'list_for_each_entry_continue'
|
||||||
|
- 'list_for_each_entry_continue_rcu'
|
||||||
|
- 'list_for_each_entry_continue_reverse'
|
||||||
|
- 'list_for_each_entry_from'
|
||||||
|
- 'list_for_each_entry_from_rcu'
|
||||||
|
- 'list_for_each_entry_from_reverse'
|
||||||
|
- 'list_for_each_entry_lockless'
|
||||||
|
- 'list_for_each_entry_rcu'
|
||||||
|
- 'list_for_each_entry_reverse'
|
||||||
|
- 'list_for_each_entry_safe'
|
||||||
|
- 'list_for_each_entry_safe_continue'
|
||||||
|
- 'list_for_each_entry_safe_from'
|
||||||
|
- 'list_for_each_entry_safe_reverse'
|
||||||
|
- 'list_for_each_prev'
|
||||||
|
- 'list_for_each_prev_safe'
|
||||||
|
- 'list_for_each_safe'
|
||||||
|
- 'llist_for_each'
|
||||||
|
- 'llist_for_each_entry'
|
||||||
|
- 'llist_for_each_entry_safe'
|
||||||
|
- 'llist_for_each_safe'
|
||||||
|
- 'mci_for_each_dimm'
|
||||||
|
- 'media_device_for_each_entity'
|
||||||
|
- 'media_device_for_each_intf'
|
||||||
|
- 'media_device_for_each_link'
|
||||||
|
- 'media_device_for_each_pad'
|
||||||
|
- 'nanddev_io_for_each_page'
|
||||||
|
- 'netdev_for_each_lower_dev'
|
||||||
|
- 'netdev_for_each_lower_private'
|
||||||
|
- 'netdev_for_each_lower_private_rcu'
|
||||||
|
- 'netdev_for_each_mc_addr'
|
||||||
|
- 'netdev_for_each_uc_addr'
|
||||||
|
- 'netdev_for_each_upper_dev_rcu'
|
||||||
|
- 'netdev_hw_addr_list_for_each'
|
||||||
|
- 'nft_rule_for_each_expr'
|
||||||
|
- 'nla_for_each_attr'
|
||||||
|
- 'nla_for_each_nested'
|
||||||
|
- 'nlmsg_for_each_attr'
|
||||||
|
- 'nlmsg_for_each_msg'
|
||||||
|
- 'nr_neigh_for_each'
|
||||||
|
- 'nr_neigh_for_each_safe'
|
||||||
|
- 'nr_node_for_each'
|
||||||
|
- 'nr_node_for_each_safe'
|
||||||
|
- 'of_for_each_phandle'
|
||||||
|
- 'of_property_for_each_string'
|
||||||
|
- 'of_property_for_each_u32'
|
||||||
|
- 'pci_bus_for_each_resource'
|
||||||
|
- 'ping_portaddr_for_each_entry'
|
||||||
|
- 'plist_for_each'
|
||||||
|
- 'plist_for_each_continue'
|
||||||
|
- 'plist_for_each_entry'
|
||||||
|
- 'plist_for_each_entry_continue'
|
||||||
|
- 'plist_for_each_entry_safe'
|
||||||
|
- 'plist_for_each_safe'
|
||||||
|
- 'pnp_for_each_card'
|
||||||
|
- 'pnp_for_each_dev'
|
||||||
|
- 'protocol_for_each_card'
|
||||||
|
- 'protocol_for_each_dev'
|
||||||
|
- 'queue_for_each_hw_ctx'
|
||||||
|
- 'radix_tree_for_each_slot'
|
||||||
|
- 'radix_tree_for_each_tagged'
|
||||||
|
- 'rbtree_postorder_for_each_entry_safe'
|
||||||
|
- 'rdma_for_each_block'
|
||||||
|
- 'rdma_for_each_port'
|
||||||
|
- 'resource_list_for_each_entry'
|
||||||
|
- 'resource_list_for_each_entry_safe'
|
||||||
|
- 'rhl_for_each_entry_rcu'
|
||||||
|
- 'rhl_for_each_rcu'
|
||||||
|
- 'rht_for_each'
|
||||||
|
- 'rht_for_each_entry'
|
||||||
|
- 'rht_for_each_entry_from'
|
||||||
|
- 'rht_for_each_entry_rcu'
|
||||||
|
- 'rht_for_each_entry_rcu_from'
|
||||||
|
- 'rht_for_each_entry_safe'
|
||||||
|
- 'rht_for_each_from'
|
||||||
|
- 'rht_for_each_rcu'
|
||||||
|
- 'rht_for_each_rcu_from'
|
||||||
|
- '__rq_for_each_bio'
|
||||||
|
- 'rq_for_each_bvec'
|
||||||
|
- 'rq_for_each_segment'
|
||||||
|
- 'scsi_for_each_prot_sg'
|
||||||
|
- 'scsi_for_each_sg'
|
||||||
|
- 'sctp_for_each_hentry'
|
||||||
|
- 'sctp_skb_for_each'
|
||||||
|
- 'shdma_for_each_chan'
|
||||||
|
- '__shost_for_each_device'
|
||||||
|
- 'shost_for_each_device'
|
||||||
|
- 'sk_for_each'
|
||||||
|
- 'sk_for_each_bound'
|
||||||
|
- 'sk_for_each_entry_offset_rcu'
|
||||||
|
- 'sk_for_each_from'
|
||||||
|
- 'sk_for_each_rcu'
|
||||||
|
- 'sk_for_each_safe'
|
||||||
|
- 'sk_nulls_for_each'
|
||||||
|
- 'sk_nulls_for_each_from'
|
||||||
|
- 'sk_nulls_for_each_rcu'
|
||||||
|
- 'snd_array_for_each'
|
||||||
|
- 'snd_pcm_group_for_each_entry'
|
||||||
|
- 'snd_soc_dapm_widget_for_each_path'
|
||||||
|
- 'snd_soc_dapm_widget_for_each_path_safe'
|
||||||
|
- 'snd_soc_dapm_widget_for_each_sink_path'
|
||||||
|
- 'snd_soc_dapm_widget_for_each_source_path'
|
||||||
|
- 'tb_property_for_each'
|
||||||
|
- 'tcf_exts_for_each_action'
|
||||||
|
- 'udp_portaddr_for_each_entry'
|
||||||
|
- 'udp_portaddr_for_each_entry_rcu'
|
||||||
|
- 'usb_hub_for_each_child'
|
||||||
|
- 'v4l2_device_for_each_subdev'
|
||||||
|
- 'v4l2_m2m_for_each_dst_buf'
|
||||||
|
- 'v4l2_m2m_for_each_dst_buf_safe'
|
||||||
|
- 'v4l2_m2m_for_each_src_buf'
|
||||||
|
- 'v4l2_m2m_for_each_src_buf_safe'
|
||||||
|
- 'virtio_device_for_each_vq'
|
||||||
|
- 'xa_for_each'
|
||||||
|
- 'xa_for_each_marked'
|
||||||
|
- 'xa_for_each_range'
|
||||||
|
- 'xa_for_each_start'
|
||||||
|
- 'xas_for_each'
|
||||||
|
- 'xas_for_each_conflict'
|
||||||
|
- 'xas_for_each_marked'
|
||||||
|
- 'xbc_array_for_each_value'
|
||||||
|
- 'xbc_for_each_key_value'
|
||||||
|
- 'xbc_node_for_each_array_value'
|
||||||
|
- 'xbc_node_for_each_child'
|
||||||
|
- 'xbc_node_for_each_key_value'
|
||||||
|
- 'zorro_for_each_dev'
|
||||||
|
|
||||||
|
#IncludeBlocks: Preserve # Unknown to clang-format-5.0
|
||||||
|
IncludeCategories:
|
||||||
|
- Regex: '.*'
|
||||||
|
Priority: 1
|
||||||
|
IncludeIsMainRegex: '(Test)?$'
|
||||||
|
IndentCaseLabels: false
|
||||||
|
#IndentPPDirectives: None # Unknown to clang-format-5.0
|
||||||
|
IndentWidth: 8
|
||||||
|
IndentWrappedFunctionNames: false
|
||||||
|
JavaScriptQuotes: Leave
|
||||||
|
JavaScriptWrapImports: true
|
||||||
|
KeepEmptyLinesAtTheStartOfBlocks: false
|
||||||
|
MacroBlockBegin: ''
|
||||||
|
MacroBlockEnd: ''
|
||||||
|
MaxEmptyLinesToKeep: 1
|
||||||
|
NamespaceIndentation: Inner
|
||||||
|
#ObjCBinPackProtocolList: Auto # Unknown to clang-format-5.0
|
||||||
|
ObjCBlockIndentWidth: 8
|
||||||
|
ObjCSpaceAfterProperty: true
|
||||||
|
ObjCSpaceBeforeProtocolList: true
|
||||||
|
|
||||||
|
# Taken from git's rules
|
||||||
|
#PenaltyBreakAssignment: 10 # Unknown to clang-format-4.0
|
||||||
|
PenaltyBreakBeforeFirstCallParameter: 30
|
||||||
|
PenaltyBreakComment: 10
|
||||||
|
PenaltyBreakFirstLessLess: 0
|
||||||
|
PenaltyBreakString: 10
|
||||||
|
PenaltyExcessCharacter: 100
|
||||||
|
PenaltyReturnTypeOnItsOwnLine: 60
|
||||||
|
|
||||||
|
PointerAlignment: Right
|
||||||
|
ReflowComments: false
|
||||||
|
SortIncludes: false
|
||||||
|
#SortUsingDeclarations: false # Unknown to clang-format-4.0
|
||||||
|
SpaceAfterCStyleCast: false
|
||||||
|
SpaceAfterTemplateKeyword: true
|
||||||
|
SpaceBeforeAssignmentOperators: true
|
||||||
|
#SpaceBeforeCtorInitializerColon: true # Unknown to clang-format-5.0
|
||||||
|
#SpaceBeforeInheritanceColon: true # Unknown to clang-format-5.0
|
||||||
|
SpaceBeforeParens: ControlStatements
|
||||||
|
#SpaceBeforeRangeBasedForLoopColon: true # Unknown to clang-format-5.0
|
||||||
|
SpaceInEmptyParentheses: false
|
||||||
|
SpacesBeforeTrailingComments: 1
|
||||||
|
SpacesInAngles: false
|
||||||
|
SpacesInContainerLiterals: false
|
||||||
|
SpacesInCStyleCastParentheses: false
|
||||||
|
SpacesInParentheses: false
|
||||||
|
SpacesInSquareBrackets: false
|
||||||
|
Standard: Cpp03
|
||||||
|
TabWidth: 8
|
||||||
|
UseTab: Always
|
||||||
|
...
|
||||||
@@ -104,3 +104,11 @@ osmo_trx_lms_LDADD = \
|
|||||||
$(LMS_LIBS)
|
$(LMS_LIBS)
|
||||||
osmo_trx_lms_CPPFLAGS = $(AM_CPPFLAGS) $(LMS_CFLAGS)
|
osmo_trx_lms_CPPFLAGS = $(AM_CPPFLAGS) $(LMS_CFLAGS)
|
||||||
endif
|
endif
|
||||||
|
|
||||||
|
bin_PROGRAMS += osmo-trx-ipc
|
||||||
|
osmo_trx_ipc_SOURCES = osmo-trx.cpp
|
||||||
|
osmo_trx_ipc_LDADD = \
|
||||||
|
$(builddir)/device/ipc/libdevice.la \
|
||||||
|
$(COMMON_LDADD) \
|
||||||
|
$(UHD_LIBS)
|
||||||
|
osmo_trx_ipc_CPPFLAGS = $(AM_CPPFLAGS) $(UHD_CFLAGS)
|
||||||
|
|||||||
@@ -2,6 +2,10 @@ include $(top_srcdir)/Makefile.common
|
|||||||
|
|
||||||
SUBDIRS = common
|
SUBDIRS = common
|
||||||
|
|
||||||
|
#if DEVICE_IPC
|
||||||
|
SUBDIRS += ipc
|
||||||
|
#endif
|
||||||
|
|
||||||
if DEVICE_USRP1
|
if DEVICE_USRP1
|
||||||
SUBDIRS += usrp1
|
SUBDIRS += usrp1
|
||||||
endif
|
endif
|
||||||
|
|||||||
1131
Transceiver52M/device/ipc/IPCDevice.cpp
Normal file
1131
Transceiver52M/device/ipc/IPCDevice.cpp
Normal file
File diff suppressed because it is too large
Load Diff
236
Transceiver52M/device/ipc/IPCDevice.h
Normal file
236
Transceiver52M/device/ipc/IPCDevice.h
Normal file
@@ -0,0 +1,236 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Pau Espin Pedrol <pespin@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: AGPL-3.0+
|
||||||
|
*
|
||||||
|
* This software is distributed under multiple licenses; see the COPYING file in
|
||||||
|
* the main directory for licensing information for this specific distribution.
|
||||||
|
*
|
||||||
|
* This use of this software may be subject to additional restrictions.
|
||||||
|
* See the LEGAL file in the main directory for details.
|
||||||
|
|
||||||
|
This program is distributed in the hope that it will be useful,
|
||||||
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
||||||
|
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _IPC_DEVICE_H_
|
||||||
|
#define _IPC_DEVICE_H_
|
||||||
|
|
||||||
|
#ifdef HAVE_CONFIG_H
|
||||||
|
#include "config.h"
|
||||||
|
#endif
|
||||||
|
|
||||||
|
extern "C" {
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
#include <osmocom/core/timer.h>
|
||||||
|
#include "shm.h"
|
||||||
|
#include "ipc_shm.h"
|
||||||
|
}
|
||||||
|
|
||||||
|
#include "radioDevice.h"
|
||||||
|
#include "smpl_buf.h"
|
||||||
|
|
||||||
|
#include <sys/time.h>
|
||||||
|
#include <math.h>
|
||||||
|
#include <limits.h>
|
||||||
|
#include <string>
|
||||||
|
#include <iostream>
|
||||||
|
#include <lime/LimeSuite.h>
|
||||||
|
|
||||||
|
struct ipc_sock_state {
|
||||||
|
struct osmo_fd conn_bfd; /* fd for connection to the BTS */
|
||||||
|
struct osmo_timer_list timer; /* socket connect retry timer */
|
||||||
|
struct llist_head upqueue; /* queue for sending messages */
|
||||||
|
};
|
||||||
|
|
||||||
|
/** A class to handle a LimeSuite supported device */
|
||||||
|
class IPCDevice : public RadioDevice {
|
||||||
|
protected:
|
||||||
|
struct ipc_sock_state sk_state;
|
||||||
|
/* FIXME: current limit 8 chans, make dynamic */
|
||||||
|
struct ipc_sock_state sk_chan_state[8];
|
||||||
|
uint8_t tmp_state;
|
||||||
|
char shm_name[SHM_NAME_MAX];
|
||||||
|
int ipc_shm_connect(const char *shm_name);
|
||||||
|
void *shm;
|
||||||
|
struct ipc_shm_region *shm_dec;
|
||||||
|
|
||||||
|
std::vector<smpl_buf *> rx_buffers;
|
||||||
|
double actualSampleRate; ///< the actual USRP sampling rate
|
||||||
|
|
||||||
|
bool started; ///< flag indicates LMS has started
|
||||||
|
bool skipRx; ///< set if LMS is transmit-only.
|
||||||
|
|
||||||
|
TIMESTAMP ts_initial, ts_offset;
|
||||||
|
|
||||||
|
std::vector<double> tx_gains, rx_gains;
|
||||||
|
|
||||||
|
struct ipc_sk_if_info_req current_info_req;
|
||||||
|
struct ipc_sk_if_info_cnf current_info_cnf;
|
||||||
|
struct ipc_sk_if_open_cnf current_open_cnf;
|
||||||
|
|
||||||
|
std::vector<struct ipc_shm_io *> shm_io_rx_streams;
|
||||||
|
std::vector<struct ipc_shm_io *> shm_io_tx_streams;
|
||||||
|
|
||||||
|
bool do_calib(size_t chan);
|
||||||
|
bool do_filters(size_t chan);
|
||||||
|
int get_ant_idx(const std::string &name, bool dir_tx, size_t chan);
|
||||||
|
virtual bool flush_recv(size_t num_pkts);
|
||||||
|
void update_stream_stats_rx(size_t chan, bool *overrun);
|
||||||
|
void update_stream_stats_tx(size_t chan, bool *underrun);
|
||||||
|
bool do_clock_src_freq(enum ReferenceType ref, double freq);
|
||||||
|
|
||||||
|
public:
|
||||||
|
virtual void ipc_sock_close(ipc_sock_state *state);
|
||||||
|
virtual int ipc_sock_read(struct osmo_fd *bfd);
|
||||||
|
virtual int ipc_sock_write(struct osmo_fd *bfd);
|
||||||
|
virtual int ipc_rx(uint8_t msg_type, struct ipc_sk_if *ipc_prim);
|
||||||
|
virtual int ipc_rx_greeting_cnf(const struct ipc_sk_if_greeting *greeting_cnf);
|
||||||
|
virtual int ipc_rx_info_cnf(const struct ipc_sk_if_info_cnf *info_cnf);
|
||||||
|
virtual int ipc_rx_open_cnf(const struct ipc_sk_if_open_cnf *open_cnf);
|
||||||
|
virtual int ipc_tx_open_req(struct ipc_sock_state *state, uint32_t num_chans, uint32_t ref);
|
||||||
|
|
||||||
|
/** Object constructor */
|
||||||
|
IPCDevice(size_t tx_sps, size_t rx_sps, InterfaceType iface, size_t chan_num, double lo_offset,
|
||||||
|
const std::vector<std::string> &tx_paths, const std::vector<std::string> &rx_paths);
|
||||||
|
virtual ~IPCDevice() override;
|
||||||
|
|
||||||
|
/** Instantiate the LMS */
|
||||||
|
virtual int open(const std::string &args, int ref, bool swap_channels) override;
|
||||||
|
|
||||||
|
/** Start the LMS */
|
||||||
|
virtual bool start() override;
|
||||||
|
|
||||||
|
/** Stop the LMS */
|
||||||
|
virtual bool stop() override;
|
||||||
|
|
||||||
|
enum TxWindowType getWindowType() override
|
||||||
|
{
|
||||||
|
return TX_WINDOW_LMS1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
Read samples from the LMS.
|
||||||
|
@param buf preallocated buf to contain read result
|
||||||
|
@param len number of samples desired
|
||||||
|
@param overrun Set if read buffer has been overrun, e.g. data not being read fast enough
|
||||||
|
@param timestamp The timestamp of the first samples to be read
|
||||||
|
@param underrun Set if LMS does not have data to transmit, e.g. data not being sent fast enough
|
||||||
|
@return The number of samples actually read
|
||||||
|
*/
|
||||||
|
virtual int readSamples(std::vector<short *> &buf, int len, bool *overrun, TIMESTAMP timestamp = 0xffffffff,
|
||||||
|
bool *underrun = NULL) override;
|
||||||
|
/**
|
||||||
|
Write samples to the LMS.
|
||||||
|
@param buf Contains the data to be written.
|
||||||
|
@param len number of samples to write.
|
||||||
|
@param underrun Set if LMS does not have data to transmit, e.g. data not being sent fast enough
|
||||||
|
@param timestamp The timestamp of the first sample of the data buffer.
|
||||||
|
@return The number of samples actually written
|
||||||
|
*/
|
||||||
|
virtual int writeSamples(std::vector<short *> &bufs, int len, bool *underrun,
|
||||||
|
TIMESTAMP timestamp = 0xffffffff) override;
|
||||||
|
|
||||||
|
/** Update the alignment between the read and write timestamps */
|
||||||
|
virtual bool updateAlignment(TIMESTAMP timestamp) override;
|
||||||
|
|
||||||
|
/** Set the transmitter frequency */
|
||||||
|
virtual bool setTxFreq(double wFreq, size_t chan = 0) override;
|
||||||
|
|
||||||
|
/** Set the receiver frequency */
|
||||||
|
virtual bool setRxFreq(double wFreq, size_t chan = 0) override;
|
||||||
|
|
||||||
|
/** Returns the starting write Timestamp*/
|
||||||
|
virtual TIMESTAMP initialWriteTimestamp(void) override;
|
||||||
|
|
||||||
|
/** Returns the starting read Timestamp*/
|
||||||
|
virtual TIMESTAMP initialReadTimestamp(void) override;
|
||||||
|
|
||||||
|
/** returns the full-scale transmit amplitude **/
|
||||||
|
virtual double fullScaleInputValue() override
|
||||||
|
{
|
||||||
|
return (double)SHRT_MAX * current_info_cnf.iq_scaling_val_rx;
|
||||||
|
}
|
||||||
|
|
||||||
|
/** returns the full-scale receive amplitude **/
|
||||||
|
virtual double fullScaleOutputValue() override
|
||||||
|
{
|
||||||
|
return (double)SHRT_MAX * current_info_cnf.iq_scaling_val_tx;
|
||||||
|
}
|
||||||
|
|
||||||
|
/** sets the receive chan gain, returns the gain setting **/
|
||||||
|
virtual double setRxGain(double dB, size_t chan = 0) override;
|
||||||
|
|
||||||
|
/** get the current receive gain */
|
||||||
|
virtual double getRxGain(size_t chan = 0) override
|
||||||
|
{
|
||||||
|
return rx_gains[chan];
|
||||||
|
}
|
||||||
|
|
||||||
|
/** return maximum Rx Gain **/
|
||||||
|
virtual double maxRxGain(void) override;
|
||||||
|
|
||||||
|
/** return minimum Rx Gain **/
|
||||||
|
virtual double minRxGain(void) override;
|
||||||
|
|
||||||
|
/** sets the transmit chan gain, returns the gain setting **/
|
||||||
|
virtual double setTxGain(double dB, size_t chan = 0) override;
|
||||||
|
|
||||||
|
/** get transmit gain */
|
||||||
|
virtual double getTxGain(size_t chan = 0) override
|
||||||
|
{
|
||||||
|
return tx_gains[chan];
|
||||||
|
}
|
||||||
|
|
||||||
|
/** return maximum Tx Gain **/
|
||||||
|
virtual double maxTxGain(void) override;
|
||||||
|
|
||||||
|
/** return minimum Rx Gain **/
|
||||||
|
virtual double minTxGain(void) override;
|
||||||
|
|
||||||
|
/** sets the RX path to use, returns true if successful and false otherwise */
|
||||||
|
virtual bool setRxAntenna(const std::string &ant, size_t chan = 0) override;
|
||||||
|
|
||||||
|
/* return the used RX path */
|
||||||
|
virtual std::string getRxAntenna(size_t chan = 0) override;
|
||||||
|
|
||||||
|
/** sets the RX path to use, returns true if successful and false otherwise */
|
||||||
|
virtual bool setTxAntenna(const std::string &ant, size_t chan = 0) override;
|
||||||
|
|
||||||
|
/* return the used RX path */
|
||||||
|
virtual std::string getTxAntenna(size_t chan = 0) override;
|
||||||
|
|
||||||
|
/** return whether user drives synchronization of Tx/Rx of USRP */
|
||||||
|
virtual bool requiresRadioAlign() override;
|
||||||
|
|
||||||
|
/** return whether user drives synchronization of Tx/Rx of USRP */
|
||||||
|
virtual GSM::Time minLatency() override;
|
||||||
|
|
||||||
|
/** Return internal status values */
|
||||||
|
virtual inline double getTxFreq(size_t chan = 0) override
|
||||||
|
{
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
virtual inline double getRxFreq(size_t chan = 0) override
|
||||||
|
{
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
virtual inline double getSampleRate() override
|
||||||
|
{
|
||||||
|
return actualSampleRate;
|
||||||
|
}
|
||||||
|
int ipc_chan_sock_read(osmo_fd *bfd);
|
||||||
|
int ipc_chan_sock_write(osmo_fd *bfd);
|
||||||
|
int ipc_chan_rx(uint8_t msg_type, ipc_sk_chan_if *ipc_prim, uint8_t chan_nr);
|
||||||
|
int ipc_rx_chan_start_cnf(ipc_sk_chan_if_op_rc *ret, uint8_t chan_nr);
|
||||||
|
int ipc_rx_chan_stop_cnf(ipc_sk_chan_if_op_rc *ret, uint8_t chan_nr);
|
||||||
|
int ipc_rx_chan_setgain_cnf(ipc_sk_chan_if_gain *ret, uint8_t chan_nr);
|
||||||
|
int ipc_rx_chan_setfreq_cnf(ipc_sk_chan_if_freq_cnf *ret, uint8_t chan_nr);
|
||||||
|
int ipc_rx_chan_notify_underflow(ipc_sk_chan_if_notfiy *ret, uint8_t chan_nr);
|
||||||
|
int ipc_rx_chan_notify_overflow(ipc_sk_chan_if_notfiy *ret, uint8_t chan_nr);
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif // _IPC_DEVICE_H_
|
||||||
29
Transceiver52M/device/ipc/Makefile.am
Normal file
29
Transceiver52M/device/ipc/Makefile.am
Normal file
@@ -0,0 +1,29 @@
|
|||||||
|
include $(top_srcdir)/Makefile.common
|
||||||
|
|
||||||
|
AM_CPPFLAGS = -Wall $(STD_DEFINES_AND_INCLUDES) -I${srcdir}/../common
|
||||||
|
AM_CFLAGS = -lpthread $(LIBOSMOCORE_CFLAGS) $(LIBOSMOCTRL_CFLAGS) $(LIBOSMOVTY_CFLAGS)
|
||||||
|
AM_CXXFLAGS = -lpthread $(LIBOSMOCORE_CFLAGS) $(LIBOSMOCTRL_CFLAGS) $(LIBOSMOVTY_CFLAGS)
|
||||||
|
AM_LDFLAGS = -lpthread -lrt
|
||||||
|
|
||||||
|
noinst_HEADERS = IPCDevice.h shm.h ../uhd/UHDDevice.h uhdwrap.h
|
||||||
|
|
||||||
|
noinst_LTLIBRARIES = libdevice.la
|
||||||
|
|
||||||
|
libdevice_la_SOURCES = ipc-driver-test.c IPCDevice.cpp shm.c ../uhd/UHDDevice.cpp uhdwrap.cpp ipc_shm.c ipc_chan.c ipc_sock.c
|
||||||
|
libdevice_la_LIBADD = $(top_builddir)/Transceiver52M/device/common/libdevice_common.la
|
||||||
|
libdevice_la_CXXFLAGS = $(AM_CXXFLAGS) $(UHD_CFLAGS) -DIPCMAGIC
|
||||||
|
|
||||||
|
bin_PROGRAMS = ipc-driver-test
|
||||||
|
#ipc_driver_test_SHORTNAME = drvt
|
||||||
|
ipc_driver_test_SOURCES = ipc-driver-test.c uhdwrap.cpp ipc_shm.c ipc_chan.c ipc_sock.c ../uhd/UHDDevice.cpp
|
||||||
|
ipc_driver_test_LDADD = \
|
||||||
|
shm.lo \
|
||||||
|
$(LIBOSMOCORE_LIBS) \
|
||||||
|
$(LIBOSMOCTRL_LIBS) \
|
||||||
|
$(LIBOSMOVTY_LIBS)
|
||||||
|
ipc_driver_test_CXXFLAGS = $(AM_CXXFLAGS) $(UHD_CFLAGS)
|
||||||
|
ipc_driver_test_CPPFLAGS = $(AM_CPPFLAGS) $(UHD_CFLAGS)
|
||||||
|
ipc_driver_test_CFLAGS = $(AM_CFLAGS) $(UHD_CFLAGS)
|
||||||
|
ipc_driver_test_LDFLAGS = $(AM_LDFLAGS) $(UHD_LIBS)
|
||||||
|
ipc_driver_test_LDADD += $(top_builddir)/Transceiver52M/device/common/libdevice_common.la $(top_builddir)/CommonLibs/libcommon.la
|
||||||
|
|
||||||
467
Transceiver52M/device/ipc/ipc-driver-test.c
Normal file
467
Transceiver52M/device/ipc/ipc-driver-test.c
Normal file
@@ -0,0 +1,467 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Pau Espin Pedrol <pespin@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#define _GNU_SOURCE
|
||||||
|
#include <pthread.h>
|
||||||
|
|
||||||
|
|
||||||
|
#include <debug.h>
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <errno.h>
|
||||||
|
#include <assert.h>
|
||||||
|
#include <sys/socket.h>
|
||||||
|
#include <sys/un.h>
|
||||||
|
#include <inttypes.h>
|
||||||
|
#include <sys/mman.h>
|
||||||
|
#include <sys/stat.h> /* For mode constants */
|
||||||
|
#include <fcntl.h> /* For O_* constants */
|
||||||
|
#include <getopt.h>
|
||||||
|
|
||||||
|
#include <osmocom/core/application.h>
|
||||||
|
#include <osmocom/core/talloc.h>
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
#include <osmocom/core/socket.h>
|
||||||
|
#include <osmocom/core/logging.h>
|
||||||
|
#include <osmocom/core/utils.h>
|
||||||
|
#include <osmocom/core/msgb.h>
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
#include <osmocom/core/timer.h>
|
||||||
|
|
||||||
|
#include "shm.h"
|
||||||
|
#include "ipc_shm.h"
|
||||||
|
#include "ipc_chan.h"
|
||||||
|
#include "ipc_sock.h"
|
||||||
|
|
||||||
|
#define DEFAULT_SHM_NAME "/osmo-trx-ipc-driver-shm2"
|
||||||
|
|
||||||
|
static void *tall_ctx;
|
||||||
|
struct ipc_sock_state *global_ipc_sock_state;
|
||||||
|
|
||||||
|
/* 8 channels are plenty */
|
||||||
|
struct ipc_sock_state *global_ctrl_socks[8];
|
||||||
|
struct ipc_shm_io *ios_tx_to_device[8];
|
||||||
|
struct ipc_shm_io *ios_rx_from_device[8];
|
||||||
|
|
||||||
|
void *shm;
|
||||||
|
void *global_dev;
|
||||||
|
|
||||||
|
static struct ipc_shm_region *decoded_region;
|
||||||
|
|
||||||
|
/* Debug Areas of the code */
|
||||||
|
//enum { DMAIN,
|
||||||
|
//};
|
||||||
|
static const struct log_info_cat default_categories[] = {
|
||||||
|
[DMAIN] = {
|
||||||
|
.name = "DMAIN",
|
||||||
|
.color = NULL,
|
||||||
|
.description = "Main generic category",
|
||||||
|
.loglevel = LOGL_DEBUG,.enabled = 1,
|
||||||
|
},
|
||||||
|
[DDEV] = {
|
||||||
|
.name = "DDEV",
|
||||||
|
.description = "Device/Driver specific code",
|
||||||
|
.color = NULL,
|
||||||
|
.enabled = 1, .loglevel = LOGL_DEBUG,
|
||||||
|
},
|
||||||
|
};
|
||||||
|
|
||||||
|
const struct log_info log_infox = {
|
||||||
|
.cat = default_categories,
|
||||||
|
.num_cat = ARRAY_SIZE(default_categories),
|
||||||
|
};
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#include "uhdwrap.h"
|
||||||
|
|
||||||
|
volatile int ipc_exit_requested = 0;
|
||||||
|
|
||||||
|
static int ipc_shm_setup(const char *shm_name, size_t shm_len)
|
||||||
|
{
|
||||||
|
int fd;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE, "Opening shm path %s\n", shm_name);
|
||||||
|
if ((fd = shm_open(shm_name, O_CREAT | O_RDWR | O_TRUNC, S_IRUSR | S_IWUSR)) < 0) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR, "shm_open %d: %s\n", errno, strerror(errno));
|
||||||
|
rc = -errno;
|
||||||
|
goto err_shm_open;
|
||||||
|
}
|
||||||
|
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE, "Truncating %d to size %zu\n", fd, shm_len);
|
||||||
|
if (ftruncate(fd, shm_len) < 0) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR, "ftruncate %d: %s\n", errno, strerror(errno));
|
||||||
|
rc = -errno;
|
||||||
|
goto err_mmap;
|
||||||
|
}
|
||||||
|
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE, "mmaping shared memory fd %d\n", fd);
|
||||||
|
if ((shm = mmap(NULL, shm_len, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0)) == MAP_FAILED) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR, "mmap %d: %s\n", errno, strerror(errno));
|
||||||
|
rc = -errno;
|
||||||
|
goto err_mmap;
|
||||||
|
}
|
||||||
|
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE, "mmap'ed shared memory at addr %p\n", shm);
|
||||||
|
/* After a call to mmap(2) the file descriptor may be closed without affecting the memory mapping. */
|
||||||
|
close(fd);
|
||||||
|
return 0;
|
||||||
|
err_mmap:
|
||||||
|
shm_unlink(shm_name);
|
||||||
|
close(fd);
|
||||||
|
err_shm_open:
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
struct msgb *ipc_msgb_alloc(uint8_t msg_type)
|
||||||
|
{
|
||||||
|
struct msgb *msg;
|
||||||
|
struct ipc_sk_if *ipc_prim;
|
||||||
|
|
||||||
|
msg = msgb_alloc(sizeof(struct ipc_sk_if) + 1000, "ipc_sock_tx");
|
||||||
|
if (!msg)
|
||||||
|
return NULL;
|
||||||
|
msgb_put(msg, sizeof(struct ipc_sk_if) + 1000);
|
||||||
|
ipc_prim = (struct ipc_sk_if *)msg->data;
|
||||||
|
ipc_prim->msg_type = msg_type;
|
||||||
|
|
||||||
|
return msg;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ipc_tx_greeting_cnf(uint8_t req_version)
|
||||||
|
{
|
||||||
|
struct msgb *msg;
|
||||||
|
struct ipc_sk_if *ipc_prim;
|
||||||
|
|
||||||
|
msg = ipc_msgb_alloc(IPC_IF_MSG_GREETING_CNF);
|
||||||
|
if (!msg)
|
||||||
|
return -ENOMEM;
|
||||||
|
ipc_prim = (struct ipc_sk_if *)msg->data;
|
||||||
|
ipc_prim->u.greeting_cnf.req_version = req_version;
|
||||||
|
|
||||||
|
return ipc_sock_send(msg);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ipc_tx_info_cnf()
|
||||||
|
{
|
||||||
|
struct msgb *msg;
|
||||||
|
struct ipc_sk_if *ipc_prim;
|
||||||
|
|
||||||
|
msg = ipc_msgb_alloc(IPC_IF_MSG_INFO_CNF);
|
||||||
|
if (!msg)
|
||||||
|
return -ENOMEM;
|
||||||
|
ipc_prim = (struct ipc_sk_if *)msg->data;
|
||||||
|
|
||||||
|
uhdwrap_fill_info_cnf(ipc_prim);
|
||||||
|
|
||||||
|
return ipc_sock_send(msg);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ipc_tx_open_cnf(int rc, uint32_t num_chans, int32_t timingoffset)
|
||||||
|
{
|
||||||
|
struct msgb *msg;
|
||||||
|
struct ipc_sk_if *ipc_prim;
|
||||||
|
struct ipc_sk_if_open_cnf_chan *chan_info;
|
||||||
|
unsigned int i;
|
||||||
|
|
||||||
|
msg = ipc_msgb_alloc(IPC_IF_MSG_OPEN_CNF);
|
||||||
|
if (!msg)
|
||||||
|
return -ENOMEM;
|
||||||
|
ipc_prim = (struct ipc_sk_if *)msg->data;
|
||||||
|
ipc_prim->u.open_cnf.return_code = rc;
|
||||||
|
ipc_prim->u.open_cnf.path_delay = timingoffset; // 6.18462e-5 * 1625e3 / 6;
|
||||||
|
OSMO_STRLCPY_ARRAY(ipc_prim->u.open_cnf.shm_name, DEFAULT_SHM_NAME);
|
||||||
|
|
||||||
|
chan_info = ipc_prim->u.open_cnf.chan_info;
|
||||||
|
for (i = 0; i < num_chans; i++) {
|
||||||
|
snprintf(chan_info->chan_ipc_sk_path, sizeof(chan_info->chan_ipc_sk_path), "%s_%d", IPC_SOCK_PATH_PREFIX, i);
|
||||||
|
/* FIXME: dynamc chan limit, currently 8 */
|
||||||
|
if (i < 8)
|
||||||
|
ipc_sock_init(chan_info->chan_ipc_sk_path, &global_ctrl_socks[i], ipc_chan_sock_accept, i);
|
||||||
|
chan_info++;
|
||||||
|
}
|
||||||
|
|
||||||
|
return ipc_sock_send(msg);
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipc_rx_greeting_req(struct ipc_sk_if_greeting *greeting_req)
|
||||||
|
{
|
||||||
|
if (greeting_req->req_version == IPC_SOCK_API_VERSION)
|
||||||
|
ipc_tx_greeting_cnf(IPC_SOCK_API_VERSION);
|
||||||
|
else
|
||||||
|
ipc_tx_greeting_cnf(0);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipc_rx_info_req(struct ipc_sk_if_info_req *info_req)
|
||||||
|
{
|
||||||
|
ipc_tx_info_cnf();
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipc_rx_open_req(struct ipc_sk_if_open_req *open_req)
|
||||||
|
{
|
||||||
|
/* calculate size needed */
|
||||||
|
unsigned int len;
|
||||||
|
|
||||||
|
global_dev = uhdwrap_open(open_req);
|
||||||
|
|
||||||
|
/* b210 packet size is 2040, but our tx size is 2500, so just do *2 */
|
||||||
|
int shmbuflen = uhdwrap_get_bufsizerx(global_dev) * 2;
|
||||||
|
|
||||||
|
len = ipc_shm_encode_region(NULL, open_req->num_chans, 4, shmbuflen);
|
||||||
|
/* Here we verify num_chans, rx_path, tx_path, clockref, etc. */
|
||||||
|
int rc = ipc_shm_setup(DEFAULT_SHM_NAME, len);
|
||||||
|
len = ipc_shm_encode_region((struct ipc_shm_raw_region *)shm, open_req->num_chans, 4, shmbuflen);
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE, "%s\n", osmo_hexdump((const unsigned char *)shm, 80));
|
||||||
|
|
||||||
|
/* set up our own copy of the decoded area, we have to do it here,
|
||||||
|
* since the uhd wrapper does not allow starting single channels
|
||||||
|
* additionally go for the producer init for both, so only we are responsible for the init, instead
|
||||||
|
* of splitting it with the client and causing potential races if one side uses it too early */
|
||||||
|
decoded_region = ipc_shm_decode_region(0, (struct ipc_shm_raw_region *)shm);
|
||||||
|
for (unsigned int i = 0; i < open_req->num_chans; i++) {
|
||||||
|
// ios_tx_to_device[i] = ipc_shm_init_consumer(decoded_region->channels[i]->dl_stream);
|
||||||
|
ios_tx_to_device[i] = ipc_shm_init_producer(decoded_region->channels[i]->dl_stream);
|
||||||
|
ios_rx_from_device[i] = ipc_shm_init_producer(decoded_region->channels[i]->ul_stream);
|
||||||
|
}
|
||||||
|
|
||||||
|
ipc_tx_open_cnf(-rc, open_req->num_chans, uhdwrap_get_timingoffset(global_dev));
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void *uplink_thread(void *x_void_ptr)
|
||||||
|
{
|
||||||
|
uint32_t chann = decoded_region->num_chans;
|
||||||
|
|
||||||
|
pthread_setname_np(pthread_self(), "uplink rx");
|
||||||
|
|
||||||
|
while (!ipc_exit_requested) {
|
||||||
|
int32_t read = uhdwrap_read(global_dev, chann);
|
||||||
|
if (read < 0)
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void *downlink_thread(void *x_void_ptr)
|
||||||
|
{
|
||||||
|
int chann = decoded_region->num_chans;
|
||||||
|
pthread_setname_np(pthread_self(), "downlink tx");
|
||||||
|
|
||||||
|
while (!ipc_exit_requested) {
|
||||||
|
bool underrun;
|
||||||
|
uhdwrap_write(global_dev, chann, &underrun);
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipc_rx_chan_start_req(struct ipc_sk_chan_if_op_void *req, uint8_t chan_nr)
|
||||||
|
{
|
||||||
|
struct msgb *msg;
|
||||||
|
struct ipc_sk_chan_if *ipc_prim;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
/* no per-chan start/stop */
|
||||||
|
rc = uhdwrap_start(global_dev, chan_nr);
|
||||||
|
|
||||||
|
pthread_t rx, tx;
|
||||||
|
pthread_create(&rx, NULL, uplink_thread, 0);
|
||||||
|
pthread_create(&tx, NULL, downlink_thread, 0);
|
||||||
|
|
||||||
|
msg = ipc_msgb_alloc(IPC_IF_MSG_START_CNF);
|
||||||
|
if (!msg)
|
||||||
|
return -ENOMEM;
|
||||||
|
ipc_prim = (struct ipc_sk_chan_if *)msg->data;
|
||||||
|
ipc_prim->u.start_cnf.return_code = rc ? 0 : -1;
|
||||||
|
|
||||||
|
return ipc_chan_sock_send(msg, chan_nr);
|
||||||
|
}
|
||||||
|
int ipc_rx_chan_stop_req(struct ipc_sk_chan_if_op_void *req, uint8_t chan_nr)
|
||||||
|
{
|
||||||
|
struct msgb *msg;
|
||||||
|
struct ipc_sk_chan_if *ipc_prim;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
/* no per-chan start/stop */
|
||||||
|
rc = uhdwrap_stop(global_dev, chan_nr);
|
||||||
|
|
||||||
|
msg = ipc_msgb_alloc(IPC_IF_MSG_STOP_CNF);
|
||||||
|
if (!msg)
|
||||||
|
return -ENOMEM;
|
||||||
|
ipc_prim = (struct ipc_sk_chan_if *)msg->data;
|
||||||
|
ipc_prim->u.stop_cnf.return_code = rc ? 0 : -1;
|
||||||
|
|
||||||
|
return ipc_chan_sock_send(msg, chan_nr);
|
||||||
|
}
|
||||||
|
int ipc_rx_chan_setgain_req(struct ipc_sk_chan_if_gain *req, uint8_t chan_nr)
|
||||||
|
{
|
||||||
|
struct msgb *msg;
|
||||||
|
struct ipc_sk_chan_if *ipc_prim;
|
||||||
|
double rv;
|
||||||
|
|
||||||
|
rv = uhdwrap_set_gain(global_dev, req->gain, chan_nr, req->is_tx);
|
||||||
|
|
||||||
|
msg = ipc_msgb_alloc(IPC_IF_MSG_SETGAIN_CNF);
|
||||||
|
if (!msg)
|
||||||
|
return -ENOMEM;
|
||||||
|
ipc_prim = (struct ipc_sk_chan_if *)msg->data;
|
||||||
|
ipc_prim->u.set_gain_cnf.is_tx = req->is_tx;
|
||||||
|
ipc_prim->u.set_gain_cnf.gain = rv;
|
||||||
|
|
||||||
|
return ipc_chan_sock_send(msg, chan_nr);
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipc_rx_chan_setfreq_req(struct ipc_sk_chan_if_freq_req *req, uint8_t chan_nr)
|
||||||
|
{
|
||||||
|
struct msgb *msg;
|
||||||
|
struct ipc_sk_chan_if *ipc_prim;
|
||||||
|
bool rv;
|
||||||
|
|
||||||
|
rv = uhdwrap_set_freq(global_dev, req->freq, chan_nr, req->is_tx);
|
||||||
|
|
||||||
|
msg = ipc_msgb_alloc(IPC_IF_MSG_SETFREQ_CNF);
|
||||||
|
if (!msg)
|
||||||
|
return -ENOMEM;
|
||||||
|
ipc_prim = (struct ipc_sk_chan_if *)msg->data;
|
||||||
|
ipc_prim->u.set_freq_cnf.return_code = rv ? 0 : 1;
|
||||||
|
|
||||||
|
return ipc_chan_sock_send(msg, chan_nr);
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipc_sock_init(const char *path, struct ipc_sock_state **global_state_var,
|
||||||
|
int (*sock_callback_fn)(struct osmo_fd *fd, unsigned int what), int n)
|
||||||
|
{
|
||||||
|
struct ipc_sock_state *state;
|
||||||
|
struct osmo_fd *bfd;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
state = talloc_zero(NULL, struct ipc_sock_state);
|
||||||
|
if (!state)
|
||||||
|
return -ENOMEM;
|
||||||
|
*global_state_var = state;
|
||||||
|
|
||||||
|
INIT_LLIST_HEAD(&state->upqueue);
|
||||||
|
state->conn_bfd.fd = -1;
|
||||||
|
|
||||||
|
bfd = &state->listen_bfd;
|
||||||
|
|
||||||
|
bfd->fd = osmo_sock_unix_init(SOCK_SEQPACKET, 0, path, OSMO_SOCK_F_BIND);
|
||||||
|
if (bfd->fd < 0) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR, "Could not create %s unix socket: %s\n", path, strerror(errno));
|
||||||
|
talloc_free(state);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
bfd->when = BSC_FD_READ;
|
||||||
|
bfd->cb = sock_callback_fn;
|
||||||
|
bfd->data = state;
|
||||||
|
bfd->priv_nr = n;
|
||||||
|
|
||||||
|
rc = osmo_fd_register(bfd);
|
||||||
|
if (rc < 0) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR, "Could not register listen fd: %d\n", rc);
|
||||||
|
close(bfd->fd);
|
||||||
|
talloc_free(state);
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
//osmo_signal_register_handler(SS_GLOBAL, IPC_if_signal_cb, NULL);
|
||||||
|
|
||||||
|
LOGP(DMAIN, LOGL_INFO, "Started listening on IPC socket: %s\n", path);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void print_help(void)
|
||||||
|
{
|
||||||
|
printf( "ipc-driver-test Usage:\n"
|
||||||
|
" -h --help This message\n"
|
||||||
|
" -n --sock-num NR Master socket suffix number NR\n"
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int msocknum = 0;
|
||||||
|
|
||||||
|
static void handle_options(int argc, char **argv)
|
||||||
|
{
|
||||||
|
while (1) {
|
||||||
|
int option_index = 0, c;
|
||||||
|
const struct option long_options[] = {
|
||||||
|
{ "help", 0, 0, 'h' },
|
||||||
|
{ "sock-num", 1, 0, 'n' },
|
||||||
|
{0,0,0,0}
|
||||||
|
};
|
||||||
|
|
||||||
|
c = getopt_long(argc, argv, "hn:",
|
||||||
|
long_options, &option_index);
|
||||||
|
if (c == -1)
|
||||||
|
break;
|
||||||
|
|
||||||
|
switch (c) {
|
||||||
|
case 'h':
|
||||||
|
print_help();
|
||||||
|
exit(0);
|
||||||
|
break;
|
||||||
|
case 'n':
|
||||||
|
msocknum = atoi(optarg);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
exit(2);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (argc > optind) {
|
||||||
|
fprintf(stderr, "Unsupported positional arguments on command line\n");
|
||||||
|
exit(2);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#if defined(IPCMAGIC) && defined(__cplusplus)
|
||||||
|
extern "C" int osmo_ctx_init(const char *id);
|
||||||
|
|
||||||
|
extern "C" int magicmain(int argc, char **argv)
|
||||||
|
{
|
||||||
|
osmo_ctx_init("main");
|
||||||
|
osmo_select_init();
|
||||||
|
|
||||||
|
#else
|
||||||
|
int main(int argc, char **argv)
|
||||||
|
{
|
||||||
|
#endif
|
||||||
|
char ipc_msock_path[sizeof(IPC_SOCK_PATH_PREFIX)+3];
|
||||||
|
tall_ctx = talloc_named_const(NULL, 0, "OsmoTRX");
|
||||||
|
msgb_talloc_ctx_init(tall_ctx, 0);
|
||||||
|
osmo_init_logging2(tall_ctx, &log_infox);
|
||||||
|
log_enable_multithread();
|
||||||
|
|
||||||
|
handle_options(argc, argv);
|
||||||
|
snprintf(ipc_msock_path,sizeof(ipc_msock_path), "%s%d", IPC_SOCK_PATH_PREFIX, msocknum);
|
||||||
|
|
||||||
|
LOGP(DMAIN, LOGL_INFO, "Starting %s\n", argv[0]);
|
||||||
|
ipc_sock_init(ipc_msock_path, &global_ipc_sock_state, ipc_sock_accept, 0);
|
||||||
|
while (!ipc_exit_requested)
|
||||||
|
osmo_select_main(0);
|
||||||
|
//ipc_sock_close()
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
42
Transceiver52M/device/ipc/ipc-driver-test.h
Normal file
42
Transceiver52M/device/ipc/ipc-driver-test.h
Normal file
@@ -0,0 +1,42 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Pau Espin Pedrol <pespin@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
#pragma once
|
||||||
|
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
#include "shm.h"
|
||||||
|
|
||||||
|
extern struct ipc_sock_state *global_ipc_sock_state;
|
||||||
|
|
||||||
|
/* 8 channels are plenty */
|
||||||
|
extern struct ipc_sock_state *global_ctrl_socks[8];
|
||||||
|
extern struct ipc_shm_io *ios_tx_to_device[8];
|
||||||
|
extern struct ipc_shm_io *ios_rx_from_device[8];
|
||||||
|
|
||||||
|
struct ipc_sock_state {
|
||||||
|
struct osmo_fd listen_bfd; /* fd for listen socket */
|
||||||
|
struct osmo_fd conn_bfd; /* fd for connection to lcr */
|
||||||
|
struct llist_head upqueue; /* queue for sending messages */
|
||||||
|
};
|
||||||
|
|
||||||
|
int ipc_sock_init(const char *path, struct ipc_sock_state **global_state_var,
|
||||||
|
int (*sock_callback_fn)(struct osmo_fd *fd, unsigned int what), int n);
|
||||||
|
|
||||||
|
int ipc_rx_greeting_req(struct ipc_sk_if_greeting *greeting_req);
|
||||||
|
int ipc_rx_info_req(struct ipc_sk_if_info_req *info_req);
|
||||||
|
int ipc_rx_open_req(struct ipc_sk_if_open_req *open_req);
|
||||||
|
|
||||||
|
int ipc_rx_chan_start_req(struct ipc_sk_chan_if_op_void *req, uint8_t chan_nr);
|
||||||
|
int ipc_rx_chan_stop_req(struct ipc_sk_chan_if_op_void *req, uint8_t chan_nr);
|
||||||
|
int ipc_rx_chan_setgain_req(struct ipc_sk_chan_if_gain *req, uint8_t chan_nr);
|
||||||
|
int ipc_rx_chan_setfreq_req(struct ipc_sk_chan_if_freq_req *req, uint8_t chan_nr);
|
||||||
254
Transceiver52M/device/ipc/ipc_chan.c
Normal file
254
Transceiver52M/device/ipc/ipc_chan.c
Normal file
@@ -0,0 +1,254 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Pau Espin Pedrol <pespin@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <errno.h>
|
||||||
|
#include <assert.h>
|
||||||
|
#include <sys/socket.h>
|
||||||
|
#include <sys/un.h>
|
||||||
|
#include <inttypes.h>
|
||||||
|
#include <sys/mman.h>
|
||||||
|
#include <sys/stat.h> /* For mode constants */
|
||||||
|
#include <fcntl.h> /* For O_* constants */
|
||||||
|
|
||||||
|
#include <debug.h>
|
||||||
|
#include <osmocom/core/application.h>
|
||||||
|
#include <osmocom/core/talloc.h>
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
#include <osmocom/core/socket.h>
|
||||||
|
#include <osmocom/core/logging.h>
|
||||||
|
#include <osmocom/core/utils.h>
|
||||||
|
#include <osmocom/core/msgb.h>
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
#include <osmocom/core/timer.h>
|
||||||
|
|
||||||
|
#include "shm.h"
|
||||||
|
#include "ipc-driver-test.h"
|
||||||
|
#include "ipc_chan.h"
|
||||||
|
#include "ipc_sock.h"
|
||||||
|
|
||||||
|
static int ipc_chan_rx(uint8_t msg_type, struct ipc_sk_chan_if *ipc_prim, uint8_t chan_nr)
|
||||||
|
{
|
||||||
|
int rc = 0;
|
||||||
|
|
||||||
|
switch (msg_type) {
|
||||||
|
case IPC_IF_MSG_START_REQ:
|
||||||
|
rc = ipc_rx_chan_start_req(&ipc_prim->u.start_req, chan_nr);
|
||||||
|
break;
|
||||||
|
case IPC_IF_MSG_STOP_REQ:
|
||||||
|
rc = ipc_rx_chan_stop_req(&ipc_prim->u.stop_req, chan_nr);
|
||||||
|
break;
|
||||||
|
case IPC_IF_MSG_SETGAIN_REQ:
|
||||||
|
rc = ipc_rx_chan_setgain_req(&ipc_prim->u.set_gain_req, chan_nr);
|
||||||
|
break;
|
||||||
|
case IPC_IF_MSG_SETFREQ_REQ:
|
||||||
|
rc = ipc_rx_chan_setfreq_req(&ipc_prim->u.set_freq_req, chan_nr);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
LOGP(DMAIN, LOGL_ERROR, "Received unknown IPC msg type %d\n", msg_type);
|
||||||
|
rc = -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ipc_chan_sock_read(struct osmo_fd *bfd)
|
||||||
|
{
|
||||||
|
struct ipc_sock_state *state = (struct ipc_sock_state *)bfd->data;
|
||||||
|
struct ipc_sk_chan_if *ipc_prim;
|
||||||
|
struct msgb *msg;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
msg = msgb_alloc(sizeof(*ipc_prim) + 1000, "ipc_chan_sock_rx");
|
||||||
|
if (!msg)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
ipc_prim = (struct ipc_sk_chan_if *)msg->tail;
|
||||||
|
|
||||||
|
rc = recv(bfd->fd, msg->tail, msgb_tailroom(msg), 0);
|
||||||
|
if (rc == 0)
|
||||||
|
goto close;
|
||||||
|
|
||||||
|
if (rc < 0) {
|
||||||
|
if (errno == EAGAIN) {
|
||||||
|
msgb_free(msg);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
goto close;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (rc < (int)sizeof(*ipc_prim)) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR,
|
||||||
|
"Received %d bytes on Unix Socket, but primitive size "
|
||||||
|
"is %zu, discarding\n",
|
||||||
|
rc, sizeof(*ipc_prim));
|
||||||
|
msgb_free(msg);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
rc = ipc_chan_rx(ipc_prim->msg_type, ipc_prim, bfd->priv_nr);
|
||||||
|
|
||||||
|
/* as we always synchronously process the message in IPC_rx() and
|
||||||
|
* its callbacks, we can free the message here. */
|
||||||
|
msgb_free(msg);
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
close:
|
||||||
|
msgb_free(msg);
|
||||||
|
ipc_sock_close(state);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipc_chan_sock_send(struct msgb *msg, uint8_t chan_nr)
|
||||||
|
{
|
||||||
|
struct ipc_sock_state *state = global_ctrl_socks[chan_nr];
|
||||||
|
struct osmo_fd *conn_bfd;
|
||||||
|
|
||||||
|
if (!state)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
if (!state) {
|
||||||
|
LOGP(DMAIN, LOGL_INFO,
|
||||||
|
"IPC socket not created, "
|
||||||
|
"dropping message\n");
|
||||||
|
msgb_free(msg);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
conn_bfd = &state->conn_bfd;
|
||||||
|
if (conn_bfd->fd <= 0) {
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE,
|
||||||
|
"IPC socket not connected, "
|
||||||
|
"dropping message\n");
|
||||||
|
msgb_free(msg);
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
msgb_enqueue(&state->upqueue, msg);
|
||||||
|
conn_bfd->when |= BSC_FD_WRITE;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ipc_chan_sock_write(struct osmo_fd *bfd)
|
||||||
|
{
|
||||||
|
struct ipc_sock_state *state = (struct ipc_sock_state *)bfd->data;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
while (!llist_empty(&state->upqueue)) {
|
||||||
|
struct msgb *msg, *msg2;
|
||||||
|
struct ipc_sk_chan_if *ipc_prim;
|
||||||
|
|
||||||
|
/* peek at the beginning of the queue */
|
||||||
|
msg = llist_entry(state->upqueue.next, struct msgb, list);
|
||||||
|
ipc_prim = (struct ipc_sk_chan_if *)msg->data;
|
||||||
|
|
||||||
|
bfd->when &= ~BSC_FD_WRITE;
|
||||||
|
|
||||||
|
/* bug hunter 8-): maybe someone forgot msgb_put(...) ? */
|
||||||
|
if (!msgb_length(msg)) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR,
|
||||||
|
"message type (%d) with ZERO "
|
||||||
|
"bytes!\n",
|
||||||
|
ipc_prim->msg_type);
|
||||||
|
goto dontsend;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* try to send it over the socket */
|
||||||
|
rc = write(bfd->fd, msgb_data(msg), msgb_length(msg));
|
||||||
|
if (rc == 0)
|
||||||
|
goto close;
|
||||||
|
if (rc < 0) {
|
||||||
|
if (errno == EAGAIN) {
|
||||||
|
bfd->when |= BSC_FD_WRITE;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
goto close;
|
||||||
|
}
|
||||||
|
|
||||||
|
dontsend:
|
||||||
|
/* _after_ we send it, we can deueue */
|
||||||
|
msg2 = msgb_dequeue(&state->upqueue);
|
||||||
|
assert(msg == msg2);
|
||||||
|
msgb_free(msg);
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
close:
|
||||||
|
ipc_sock_close(state);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ipc_chan_sock_cb(struct osmo_fd *bfd, unsigned int flags)
|
||||||
|
{
|
||||||
|
int rc = 0;
|
||||||
|
|
||||||
|
if (flags & BSC_FD_READ)
|
||||||
|
rc = ipc_chan_sock_read(bfd);
|
||||||
|
if (rc < 0)
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
if (flags & BSC_FD_WRITE)
|
||||||
|
rc = ipc_chan_sock_write(bfd);
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipc_chan_sock_accept(struct osmo_fd *bfd, unsigned int flags)
|
||||||
|
{
|
||||||
|
struct ipc_sock_state *state = (struct ipc_sock_state *)bfd->data;
|
||||||
|
struct osmo_fd *conn_bfd = &state->conn_bfd;
|
||||||
|
struct sockaddr_un un_addr;
|
||||||
|
socklen_t len;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
len = sizeof(un_addr);
|
||||||
|
rc = accept(bfd->fd, (struct sockaddr *)&un_addr, &len);
|
||||||
|
if (rc < 0) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR, "Failed to accept a new connection\n");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (conn_bfd->fd >= 0) {
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE,
|
||||||
|
"osmo-trx connects but we already have "
|
||||||
|
"another active connection ?!?\n");
|
||||||
|
/* We already have one IPC connected, this is all we support */
|
||||||
|
state->listen_bfd.when &= ~BSC_FD_READ;
|
||||||
|
close(rc);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
conn_bfd->fd = rc;
|
||||||
|
conn_bfd->when = BSC_FD_READ;
|
||||||
|
conn_bfd->cb = ipc_chan_sock_cb;
|
||||||
|
conn_bfd->data = state;
|
||||||
|
|
||||||
|
if (osmo_fd_register(conn_bfd) != 0) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR,
|
||||||
|
"Failed to register new connection "
|
||||||
|
"fd\n");
|
||||||
|
close(conn_bfd->fd);
|
||||||
|
conn_bfd->fd = -1;
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE, "Unix socket connected to external osmo-trx\n");
|
||||||
|
|
||||||
|
/* send current info */
|
||||||
|
//IPC_tx_info_ind();
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
23
Transceiver52M/device/ipc/ipc_chan.h
Normal file
23
Transceiver52M/device/ipc/ipc_chan.h
Normal file
@@ -0,0 +1,23 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Pau Espin Pedrol <pespin@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
#ifndef IPC_CHAN_H
|
||||||
|
#define IPC_CHAN_H
|
||||||
|
|
||||||
|
#include "shm.h"
|
||||||
|
#include "ipc-driver-test.h"
|
||||||
|
|
||||||
|
int ipc_chan_sock_send(struct msgb *msg, uint8_t chan_nr);
|
||||||
|
int ipc_chan_sock_accept(struct osmo_fd *bfd, unsigned int flags);
|
||||||
|
|
||||||
|
#endif // IPC_CHAN_H
|
||||||
204
Transceiver52M/device/ipc/ipc_shm.c
Normal file
204
Transceiver52M/device/ipc/ipc_shm.c
Normal file
@@ -0,0 +1,204 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Eric Wild <ewild@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#include <shm.h>
|
||||||
|
#include "ipc_shm.h"
|
||||||
|
#include <pthread.h>
|
||||||
|
#include <semaphore.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <errno.h>
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#define SAMPLE_SIZE_BYTE sizeof(uint16_t) * 2
|
||||||
|
|
||||||
|
struct ipc_shm_io *ipc_shm_init_consumer(struct ipc_shm_stream *s)
|
||||||
|
{
|
||||||
|
unsigned int i;
|
||||||
|
|
||||||
|
struct ipc_shm_io *r = (struct ipc_shm_io *)malloc(sizeof(struct ipc_shm_io));
|
||||||
|
r->this_stream = s->raw;
|
||||||
|
r->buf_ptrs =
|
||||||
|
(volatile struct ipc_shm_raw_smpl_buf **)malloc(sizeof(struct ipc_shm_raw_smpl_buf *) * s->num_buffers);
|
||||||
|
|
||||||
|
/* save actual ptrs */
|
||||||
|
for (i = 0; i < s->num_buffers; i++)
|
||||||
|
r->buf_ptrs[i] = s->buffers[i];
|
||||||
|
|
||||||
|
r->partial_read_begin_ptr = 0;
|
||||||
|
return r;
|
||||||
|
}
|
||||||
|
|
||||||
|
struct ipc_shm_io *ipc_shm_init_producer(struct ipc_shm_stream *s)
|
||||||
|
{
|
||||||
|
int rv;
|
||||||
|
pthread_mutexattr_t att;
|
||||||
|
pthread_condattr_t t1, t2;
|
||||||
|
struct ipc_shm_io *r = ipc_shm_init_consumer(s);
|
||||||
|
rv = pthread_mutexattr_init(&att);
|
||||||
|
if (rv != 0) {
|
||||||
|
fprintf(stderr, "%s:%d rv:%d", __FILE__, __LINE__, rv);
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
rv = pthread_mutexattr_setrobust(&att, PTHREAD_MUTEX_ROBUST);
|
||||||
|
if (rv != 0) {
|
||||||
|
fprintf(stderr, "%s:%d rv:%d", __FILE__, __LINE__, rv);
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
rv = pthread_mutexattr_setpshared(&att, PTHREAD_PROCESS_SHARED);
|
||||||
|
if (rv != 0) {
|
||||||
|
fprintf(stderr, "%s:%d rv:%d", __FILE__, __LINE__, rv);
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
rv = pthread_mutex_init((pthread_mutex_t *)&r->this_stream->lock, &att);
|
||||||
|
if (rv != 0) {
|
||||||
|
fprintf(stderr, "%s:%d rv:%d", __FILE__, __LINE__, rv);
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
pthread_mutexattr_destroy(&att);
|
||||||
|
|
||||||
|
rv = pthread_condattr_setpshared(&t1, PTHREAD_PROCESS_SHARED);
|
||||||
|
if (rv != 0) {
|
||||||
|
fprintf(stderr, "%s:%d rv:%d", __FILE__, __LINE__, rv);
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
rv = pthread_condattr_setpshared(&t2, PTHREAD_PROCESS_SHARED);
|
||||||
|
if (rv != 0) {
|
||||||
|
fprintf(stderr, "%s:%d rv:%d", __FILE__, __LINE__, rv);
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
rv = pthread_cond_init((pthread_cond_t *)&r->this_stream->cf, &t1);
|
||||||
|
if (rv != 0) {
|
||||||
|
fprintf(stderr, "%s:%d rv:%d", __FILE__, __LINE__, rv);
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
rv = pthread_cond_init((pthread_cond_t *)&r->this_stream->ce, &t2);
|
||||||
|
if (rv != 0) {
|
||||||
|
fprintf(stderr, "%s:%d rv:%d", __FILE__, __LINE__, rv);
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
pthread_condattr_destroy(&t1);
|
||||||
|
pthread_condattr_destroy(&t2);
|
||||||
|
|
||||||
|
r->this_stream->read_next = 0;
|
||||||
|
r->this_stream->write_next = 0;
|
||||||
|
return r;
|
||||||
|
}
|
||||||
|
|
||||||
|
void ipc_shm_close(struct ipc_shm_io *r)
|
||||||
|
{
|
||||||
|
if (r) {
|
||||||
|
if (r->buf_ptrs)
|
||||||
|
free(r->buf_ptrs);
|
||||||
|
free(r);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
int32_t ipc_shm_enqueue(struct ipc_shm_io *r, uint64_t timestamp, uint32_t len_in_sps, uint16_t *data)
|
||||||
|
{
|
||||||
|
volatile struct ipc_shm_raw_smpl_buf *buf;
|
||||||
|
int32_t rv;
|
||||||
|
struct timespec tv;
|
||||||
|
clock_gettime(CLOCK_REALTIME, &tv);
|
||||||
|
tv.tv_sec += 1;
|
||||||
|
|
||||||
|
rv = pthread_mutex_timedlock((pthread_mutex_t *)&r->this_stream->lock, &tv);
|
||||||
|
if (rv != 0)
|
||||||
|
return -rv;
|
||||||
|
|
||||||
|
while (((r->this_stream->write_next + 1) & (r->this_stream->num_buffers - 1)) == r->this_stream->read_next &&
|
||||||
|
rv == 0)
|
||||||
|
rv = pthread_cond_timedwait((pthread_cond_t *)&r->this_stream->ce,
|
||||||
|
(pthread_mutex_t *)&r->this_stream->lock, &tv);
|
||||||
|
if (rv != 0)
|
||||||
|
return -rv;
|
||||||
|
|
||||||
|
buf = r->buf_ptrs[r->this_stream->write_next];
|
||||||
|
buf->timestamp = timestamp;
|
||||||
|
|
||||||
|
rv = len_in_sps <= r->this_stream->buffer_size ? len_in_sps : r->this_stream->buffer_size;
|
||||||
|
|
||||||
|
memcpy((void *)buf->samples, data, SAMPLE_SIZE_BYTE * rv);
|
||||||
|
buf->data_len = rv;
|
||||||
|
|
||||||
|
r->this_stream->write_next = (r->this_stream->write_next + 1) & (r->this_stream->num_buffers - 1);
|
||||||
|
|
||||||
|
pthread_cond_signal((pthread_cond_t *)&r->this_stream->cf);
|
||||||
|
pthread_mutex_unlock((pthread_mutex_t *)&r->this_stream->lock);
|
||||||
|
|
||||||
|
return rv;
|
||||||
|
}
|
||||||
|
|
||||||
|
int32_t ipc_shm_read(struct ipc_shm_io *r, uint16_t *out_buf, uint32_t num_samples, uint64_t *timestamp,
|
||||||
|
uint32_t timeout_seconds)
|
||||||
|
{
|
||||||
|
volatile struct ipc_shm_raw_smpl_buf *buf;
|
||||||
|
int32_t rv;
|
||||||
|
uint8_t freeflag = 0;
|
||||||
|
struct timespec tv;
|
||||||
|
clock_gettime(CLOCK_REALTIME, &tv);
|
||||||
|
tv.tv_sec += timeout_seconds;
|
||||||
|
|
||||||
|
rv = pthread_mutex_timedlock((pthread_mutex_t *)&r->this_stream->lock, &tv);
|
||||||
|
if (rv != 0)
|
||||||
|
return -rv;
|
||||||
|
|
||||||
|
while (r->this_stream->write_next == r->this_stream->read_next && rv == 0)
|
||||||
|
rv = pthread_cond_timedwait((pthread_cond_t *)&r->this_stream->cf,
|
||||||
|
(pthread_mutex_t *)&r->this_stream->lock, &tv);
|
||||||
|
if (rv != 0)
|
||||||
|
return -rv;
|
||||||
|
|
||||||
|
buf = r->buf_ptrs[r->this_stream->read_next];
|
||||||
|
if (buf->data_len <= num_samples) {
|
||||||
|
memcpy(out_buf, (void *)&buf->samples[r->partial_read_begin_ptr * 2], SAMPLE_SIZE_BYTE * buf->data_len);
|
||||||
|
r->partial_read_begin_ptr = 0;
|
||||||
|
rv = buf->data_len;
|
||||||
|
buf->data_len = 0;
|
||||||
|
r->this_stream->read_next = (r->this_stream->read_next + 1) & (r->this_stream->num_buffers - 1);
|
||||||
|
freeflag = 1;
|
||||||
|
|
||||||
|
} else /*if (buf->data_len > num_samples)*/ {
|
||||||
|
memcpy(out_buf, (void *)&buf->samples[r->partial_read_begin_ptr * 2], SAMPLE_SIZE_BYTE * num_samples);
|
||||||
|
r->partial_read_begin_ptr += num_samples;
|
||||||
|
buf->data_len -= num_samples;
|
||||||
|
rv = num_samples;
|
||||||
|
}
|
||||||
|
|
||||||
|
*timestamp = buf->timestamp;
|
||||||
|
buf->timestamp += rv;
|
||||||
|
|
||||||
|
if (freeflag)
|
||||||
|
pthread_cond_signal((pthread_cond_t *)&r->this_stream->ce);
|
||||||
|
|
||||||
|
pthread_mutex_unlock((pthread_mutex_t *)&r->this_stream->lock);
|
||||||
|
|
||||||
|
return rv;
|
||||||
|
}
|
||||||
43
Transceiver52M/device/ipc/ipc_shm.h
Normal file
43
Transceiver52M/device/ipc/ipc_shm.h
Normal file
@@ -0,0 +1,43 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Eric Wild <ewild@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
#ifndef IPC_SHM_H
|
||||||
|
#define IPC_SHM_H
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#include <shm.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
struct ipc_shm_io {
|
||||||
|
volatile struct ipc_shm_raw_stream *this_stream; // plus num_buffers at end
|
||||||
|
volatile struct ipc_shm_raw_smpl_buf **volatile buf_ptrs;
|
||||||
|
uint32_t partial_read_begin_ptr;
|
||||||
|
};
|
||||||
|
|
||||||
|
struct ipc_shm_io *ipc_shm_init_consumer(struct ipc_shm_stream *s);
|
||||||
|
struct ipc_shm_io *ipc_shm_init_producer(struct ipc_shm_stream *s);
|
||||||
|
void ipc_shm_close(struct ipc_shm_io *r);
|
||||||
|
int32_t ipc_shm_enqueue(struct ipc_shm_io *r, uint64_t timestamp, uint32_t len_in_sps, uint16_t *data);
|
||||||
|
int32_t ipc_shm_tryenqueue(struct ipc_shm_io *r, uint64_t timestamp, uint32_t len_in_sps, uint16_t *data);
|
||||||
|
volatile struct ipc_shm_raw_smpl_buf *ipc_shm_dequeue(struct ipc_shm_io *r);
|
||||||
|
int32_t ipc_shm_read(struct ipc_shm_io *r, uint16_t *out_buf, uint32_t num_samples, uint64_t *timestamp,
|
||||||
|
uint32_t timeout_seconds);
|
||||||
|
|
||||||
|
#endif // IPC_SHM_H
|
||||||
271
Transceiver52M/device/ipc/ipc_sock.c
Normal file
271
Transceiver52M/device/ipc/ipc_sock.c
Normal file
@@ -0,0 +1,271 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Pau Espin Pedrol <pespin@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <errno.h>
|
||||||
|
#include <assert.h>
|
||||||
|
#include <sys/socket.h>
|
||||||
|
#include <sys/un.h>
|
||||||
|
#include <inttypes.h>
|
||||||
|
#include <sys/mman.h>
|
||||||
|
#include <sys/stat.h> /* For mode constants */
|
||||||
|
#include <fcntl.h> /* For O_* constants */
|
||||||
|
|
||||||
|
#include <debug.h>
|
||||||
|
#include <osmocom/core/application.h>
|
||||||
|
#include <osmocom/core/talloc.h>
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
#include <osmocom/core/socket.h>
|
||||||
|
#include <osmocom/core/logging.h>
|
||||||
|
#include <osmocom/core/utils.h>
|
||||||
|
#include <osmocom/core/msgb.h>
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
#include <osmocom/core/timer.h>
|
||||||
|
|
||||||
|
#include "shm.h"
|
||||||
|
#include "ipc-driver-test.h"
|
||||||
|
|
||||||
|
extern volatile int ipc_exit_requested;
|
||||||
|
static int ipc_rx(uint8_t msg_type, struct ipc_sk_if *ipc_prim)
|
||||||
|
{
|
||||||
|
int rc = 0;
|
||||||
|
|
||||||
|
switch (msg_type) {
|
||||||
|
case IPC_IF_MSG_GREETING_REQ:
|
||||||
|
rc = ipc_rx_greeting_req(&ipc_prim->u.greeting_req);
|
||||||
|
break;
|
||||||
|
case IPC_IF_MSG_INFO_REQ:
|
||||||
|
rc = ipc_rx_info_req(&ipc_prim->u.info_req);
|
||||||
|
break;
|
||||||
|
case IPC_IF_MSG_OPEN_REQ:
|
||||||
|
rc = ipc_rx_open_req(&ipc_prim->u.open_req);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
LOGP(DMAIN, LOGL_ERROR, "Received unknown IPC msg type %d\n", msg_type);
|
||||||
|
rc = -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipc_sock_send(struct msgb *msg)
|
||||||
|
{
|
||||||
|
struct ipc_sock_state *state = global_ipc_sock_state;
|
||||||
|
struct osmo_fd *conn_bfd;
|
||||||
|
//struct ipc_sk_if *ipc_prim = (struct ipc_sk_if *) msg->data;
|
||||||
|
|
||||||
|
if (!state) {
|
||||||
|
LOGP(DMAIN, LOGL_INFO,
|
||||||
|
"IPC socket not created, "
|
||||||
|
"dropping message\n");
|
||||||
|
msgb_free(msg);
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
conn_bfd = &state->conn_bfd;
|
||||||
|
if (conn_bfd->fd <= 0) {
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE,
|
||||||
|
"IPC socket not connected, "
|
||||||
|
"dropping message\n");
|
||||||
|
msgb_free(msg);
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
msgb_enqueue(&state->upqueue, msg);
|
||||||
|
conn_bfd->when |= BSC_FD_WRITE;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void ipc_sock_close(struct ipc_sock_state *state)
|
||||||
|
{
|
||||||
|
struct osmo_fd *bfd = &state->conn_bfd;
|
||||||
|
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE, "IPC socket has LOST connection\n");
|
||||||
|
|
||||||
|
ipc_exit_requested = 1;
|
||||||
|
|
||||||
|
close(bfd->fd);
|
||||||
|
bfd->fd = -1;
|
||||||
|
osmo_fd_unregister(bfd);
|
||||||
|
|
||||||
|
/* re-enable the generation of ACCEPT for new connections */
|
||||||
|
state->listen_bfd.when |= BSC_FD_READ;
|
||||||
|
|
||||||
|
/* flush the queue */
|
||||||
|
while (!llist_empty(&state->upqueue)) {
|
||||||
|
struct msgb *msg = msgb_dequeue(&state->upqueue);
|
||||||
|
msgb_free(msg);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
int ipc_sock_read(struct osmo_fd *bfd)
|
||||||
|
{
|
||||||
|
struct ipc_sock_state *state = (struct ipc_sock_state *)bfd->data;
|
||||||
|
struct ipc_sk_if *ipc_prim;
|
||||||
|
struct msgb *msg;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
msg = msgb_alloc(sizeof(*ipc_prim) + 1000, "ipc_sock_rx");
|
||||||
|
if (!msg)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
ipc_prim = (struct ipc_sk_if *)msg->tail;
|
||||||
|
|
||||||
|
rc = recv(bfd->fd, msg->tail, msgb_tailroom(msg), 0);
|
||||||
|
if (rc == 0)
|
||||||
|
goto close;
|
||||||
|
|
||||||
|
if (rc < 0) {
|
||||||
|
if (errno == EAGAIN) {
|
||||||
|
msgb_free(msg);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
goto close;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (rc < (int)sizeof(*ipc_prim)) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR,
|
||||||
|
"Received %d bytes on Unix Socket, but primitive size "
|
||||||
|
"is %zu, discarding\n",
|
||||||
|
rc, sizeof(*ipc_prim));
|
||||||
|
msgb_free(msg);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
rc = ipc_rx(ipc_prim->msg_type, ipc_prim);
|
||||||
|
|
||||||
|
/* as we always synchronously process the message in IPC_rx() and
|
||||||
|
* its callbacks, we can free the message here. */
|
||||||
|
msgb_free(msg);
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
close:
|
||||||
|
msgb_free(msg);
|
||||||
|
ipc_sock_close(state);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ipc_sock_write(struct osmo_fd *bfd)
|
||||||
|
{
|
||||||
|
struct ipc_sock_state *state = (struct ipc_sock_state *)bfd->data;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
while (!llist_empty(&state->upqueue)) {
|
||||||
|
struct msgb *msg, *msg2;
|
||||||
|
struct ipc_sk_if *ipc_prim;
|
||||||
|
|
||||||
|
/* peek at the beginning of the queue */
|
||||||
|
msg = llist_entry(state->upqueue.next, struct msgb, list);
|
||||||
|
ipc_prim = (struct ipc_sk_if *)msg->data;
|
||||||
|
|
||||||
|
bfd->when &= ~BSC_FD_WRITE;
|
||||||
|
|
||||||
|
/* bug hunter 8-): maybe someone forgot msgb_put(...) ? */
|
||||||
|
if (!msgb_length(msg)) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR,
|
||||||
|
"message type (%d) with ZERO "
|
||||||
|
"bytes!\n",
|
||||||
|
ipc_prim->msg_type);
|
||||||
|
goto dontsend;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* try to send it over the socket */
|
||||||
|
rc = write(bfd->fd, msgb_data(msg), msgb_length(msg));
|
||||||
|
if (rc == 0)
|
||||||
|
goto close;
|
||||||
|
if (rc < 0) {
|
||||||
|
if (errno == EAGAIN) {
|
||||||
|
bfd->when |= BSC_FD_WRITE;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
goto close;
|
||||||
|
}
|
||||||
|
|
||||||
|
dontsend:
|
||||||
|
/* _after_ we send it, we can deueue */
|
||||||
|
msg2 = msgb_dequeue(&state->upqueue);
|
||||||
|
assert(msg == msg2);
|
||||||
|
msgb_free(msg);
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
close:
|
||||||
|
ipc_sock_close(state);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ipc_sock_cb(struct osmo_fd *bfd, unsigned int flags)
|
||||||
|
{
|
||||||
|
int rc = 0;
|
||||||
|
|
||||||
|
if (flags & BSC_FD_READ)
|
||||||
|
rc = ipc_sock_read(bfd);
|
||||||
|
if (rc < 0)
|
||||||
|
return rc;
|
||||||
|
|
||||||
|
if (flags & BSC_FD_WRITE)
|
||||||
|
rc = ipc_sock_write(bfd);
|
||||||
|
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* accept connection coming from IPC */
|
||||||
|
int ipc_sock_accept(struct osmo_fd *bfd, unsigned int flags)
|
||||||
|
{
|
||||||
|
struct ipc_sock_state *state = (struct ipc_sock_state *)bfd->data;
|
||||||
|
struct osmo_fd *conn_bfd = &state->conn_bfd;
|
||||||
|
struct sockaddr_un un_addr;
|
||||||
|
socklen_t len;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
len = sizeof(un_addr);
|
||||||
|
rc = accept(bfd->fd, (struct sockaddr *)&un_addr, &len);
|
||||||
|
if (rc < 0) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR, "Failed to accept a new connection\n");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (conn_bfd->fd >= 0) {
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE,
|
||||||
|
"ip clent connects but we already have "
|
||||||
|
"another active connection ?!?\n");
|
||||||
|
/* We already have one IPC connected, this is all we support */
|
||||||
|
state->listen_bfd.when &= ~BSC_FD_READ;
|
||||||
|
close(rc);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
conn_bfd->fd = rc;
|
||||||
|
conn_bfd->when = BSC_FD_READ;
|
||||||
|
conn_bfd->cb = ipc_sock_cb;
|
||||||
|
conn_bfd->data = state;
|
||||||
|
|
||||||
|
if (osmo_fd_register(conn_bfd) != 0) {
|
||||||
|
LOGP(DMAIN, LOGL_ERROR,
|
||||||
|
"Failed to register new connection "
|
||||||
|
"fd\n");
|
||||||
|
close(conn_bfd->fd);
|
||||||
|
conn_bfd->fd = -1;
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
LOGP(DMAIN, LOGL_NOTICE, "Unix socket connected to external osmo-trx\n");
|
||||||
|
|
||||||
|
/* send current info */
|
||||||
|
//IPC_tx_info_ind();
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
24
Transceiver52M/device/ipc/ipc_sock.h
Normal file
24
Transceiver52M/device/ipc/ipc_sock.h
Normal file
@@ -0,0 +1,24 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Pau Espin Pedrol <pespin@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
#ifndef IPC_SOCK_H
|
||||||
|
#define IPC_SOCK_H
|
||||||
|
|
||||||
|
#include "shm.h"
|
||||||
|
#include "ipc-driver-test.h"
|
||||||
|
|
||||||
|
int ipc_sock_send(struct msgb *msg);
|
||||||
|
int ipc_sock_accept(struct osmo_fd *bfd, unsigned int flags);
|
||||||
|
void ipc_sock_close(struct ipc_sock_state *state);
|
||||||
|
|
||||||
|
#endif // IPC_SOCK_H
|
||||||
165
Transceiver52M/device/ipc/shm.c
Normal file
165
Transceiver52M/device/ipc/shm.c
Normal file
@@ -0,0 +1,165 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Pau Espin Pedrol <pespin@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <stddef.h>
|
||||||
|
#include <osmocom/core/talloc.h>
|
||||||
|
|
||||||
|
#include "shm.h"
|
||||||
|
|
||||||
|
//#define ENCDECDEBUG
|
||||||
|
|
||||||
|
/* Convert offsets to pointers */
|
||||||
|
struct ipc_shm_stream *ipc_shm_decode_stream(void *tall_ctx, struct ipc_shm_raw_region *root_raw,
|
||||||
|
struct ipc_shm_raw_stream *stream_raw)
|
||||||
|
{
|
||||||
|
unsigned int i;
|
||||||
|
struct ipc_shm_stream *stream;
|
||||||
|
stream = talloc_zero(tall_ctx, struct ipc_shm_stream);
|
||||||
|
stream = talloc_zero_size(tall_ctx, sizeof(struct ipc_shm_stream) +
|
||||||
|
sizeof(struct ipc_shm_raw_smpl_buf *) * stream_raw->num_buffers);
|
||||||
|
if (!stream)
|
||||||
|
return NULL;
|
||||||
|
stream->num_buffers = stream_raw->num_buffers;
|
||||||
|
stream->buffer_size = stream_raw->buffer_size;
|
||||||
|
stream->raw = stream_raw;
|
||||||
|
for (i = 0; i < stream->num_buffers; i++) {
|
||||||
|
#ifdef ENCDECDEBUG
|
||||||
|
fprintf(stderr, "decode: smpl_buf %d at offset %u\n", i, stream_raw->buffer_offset[i]);
|
||||||
|
#endif
|
||||||
|
stream->buffers[i] =
|
||||||
|
(struct ipc_shm_raw_smpl_buf *)(((uint8_t *)root_raw) + stream_raw->buffer_offset[i]);
|
||||||
|
}
|
||||||
|
return stream;
|
||||||
|
}
|
||||||
|
|
||||||
|
struct ipc_shm_channel *ipc_shm_decode_channel(void *tall_ctx, struct ipc_shm_raw_region *root_raw,
|
||||||
|
struct ipc_shm_raw_channel *chan_raw)
|
||||||
|
{
|
||||||
|
struct ipc_shm_channel *chan;
|
||||||
|
chan = talloc_zero(tall_ctx, struct ipc_shm_channel);
|
||||||
|
if (!chan)
|
||||||
|
return NULL;
|
||||||
|
#ifdef ENCDECDEBUG
|
||||||
|
fprintf(stderr, "decode: streams at offset %u and %u\n", chan_raw->dl_buf_offset, chan_raw->ul_buf_offset);
|
||||||
|
#endif
|
||||||
|
chan->dl_stream = ipc_shm_decode_stream(
|
||||||
|
chan, root_raw, (struct ipc_shm_raw_stream *)(((uint8_t *)root_raw) + chan_raw->dl_buf_offset));
|
||||||
|
chan->ul_stream = ipc_shm_decode_stream(
|
||||||
|
chan, root_raw, (struct ipc_shm_raw_stream *)(((uint8_t *)root_raw) + chan_raw->ul_buf_offset));
|
||||||
|
return chan;
|
||||||
|
}
|
||||||
|
struct ipc_shm_region *ipc_shm_decode_region(void *tall_ctx, struct ipc_shm_raw_region *root_raw)
|
||||||
|
{
|
||||||
|
unsigned int i;
|
||||||
|
struct ipc_shm_region *root;
|
||||||
|
root = talloc_zero_size(tall_ctx,
|
||||||
|
sizeof(struct ipc_shm_region) + sizeof(struct ipc_shm_channel *) * root_raw->num_chans);
|
||||||
|
if (!root)
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
root->num_chans = root_raw->num_chans;
|
||||||
|
for (i = 0; i < root->num_chans; i++) {
|
||||||
|
#ifdef ENCDECDEBUG
|
||||||
|
fprintf(stderr, "decode: channel %d at offset %u\n", i, root_raw->chan_offset[i]);
|
||||||
|
#endif
|
||||||
|
root->channels[i] = ipc_shm_decode_channel(
|
||||||
|
root, root_raw,
|
||||||
|
(struct ipc_shm_raw_channel *)(((uint8_t *)root_raw) + root_raw->chan_offset[i]));
|
||||||
|
}
|
||||||
|
return root;
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned int ipc_shm_encode_smpl_buf(struct ipc_shm_raw_region *root_raw, struct ipc_shm_raw_smpl_buf *smpl_buf_raw,
|
||||||
|
uint32_t buffer_size)
|
||||||
|
{
|
||||||
|
uint8_t *start = (uint8_t *)smpl_buf_raw;
|
||||||
|
unsigned int offset = sizeof(struct ipc_shm_raw_smpl_buf);
|
||||||
|
offset = (((uintptr_t)offset + 7) & ~0x07ULL);
|
||||||
|
#ifdef ENCDECDEBUG
|
||||||
|
fprintf(stderr, "encode: smpl_buf at offset %lu\n", (start - (uint8_t *)root_raw));
|
||||||
|
#endif
|
||||||
|
offset += buffer_size * sizeof(uint16_t) * 2; /* samples */
|
||||||
|
return offset;
|
||||||
|
}
|
||||||
|
|
||||||
|
unsigned int ipc_shm_encode_stream(struct ipc_shm_raw_region *root_raw, struct ipc_shm_raw_stream *stream_raw,
|
||||||
|
uint32_t num_buffers, uint32_t buffer_size)
|
||||||
|
{
|
||||||
|
unsigned int i;
|
||||||
|
ptrdiff_t start = (ptrdiff_t)stream_raw;
|
||||||
|
unsigned int offset = sizeof(struct ipc_shm_raw_stream) + sizeof(uint32_t) * num_buffers;
|
||||||
|
offset = (((uintptr_t)offset + 7) & ~0x07ULL);
|
||||||
|
#ifdef ENCDECDEBUG
|
||||||
|
fprintf(stderr, "encode: stream at offset %lu\n", (start - (ptrdiff_t)root_raw));
|
||||||
|
#endif
|
||||||
|
if (root_raw) {
|
||||||
|
stream_raw->num_buffers = num_buffers;
|
||||||
|
stream_raw->buffer_size = buffer_size;
|
||||||
|
stream_raw->read_next = 0;
|
||||||
|
stream_raw->write_next = 0;
|
||||||
|
}
|
||||||
|
for (i = 0; i < num_buffers; i++) {
|
||||||
|
if (root_raw)
|
||||||
|
stream_raw->buffer_offset[i] = (start + offset - (ptrdiff_t)root_raw);
|
||||||
|
offset +=
|
||||||
|
ipc_shm_encode_smpl_buf(root_raw, (struct ipc_shm_raw_smpl_buf *)(start + offset), buffer_size);
|
||||||
|
}
|
||||||
|
return offset;
|
||||||
|
}
|
||||||
|
unsigned int ipc_shm_encode_channel(struct ipc_shm_raw_region *root_raw, struct ipc_shm_raw_channel *chan_raw,
|
||||||
|
uint32_t num_buffers, uint32_t buffer_size)
|
||||||
|
{
|
||||||
|
uint8_t *start = (uint8_t *)chan_raw;
|
||||||
|
unsigned int offset = sizeof(struct ipc_shm_raw_channel);
|
||||||
|
offset = (((uintptr_t)offset + 7) & ~0x07ULL);
|
||||||
|
#ifdef ENCDECDEBUG
|
||||||
|
fprintf(stderr, "encode: channel at offset %lu\n", (start - (uint8_t *)root_raw));
|
||||||
|
#endif
|
||||||
|
if (root_raw)
|
||||||
|
chan_raw->dl_buf_offset = (start + offset - (uint8_t *)root_raw);
|
||||||
|
offset += ipc_shm_encode_stream(root_raw, (struct ipc_shm_raw_stream *)(start + offset), num_buffers,
|
||||||
|
buffer_size);
|
||||||
|
if (root_raw)
|
||||||
|
chan_raw->ul_buf_offset = (start + offset - (uint8_t *)root_raw);
|
||||||
|
offset += ipc_shm_encode_stream(root_raw, (struct ipc_shm_raw_stream *)(start + offset), num_buffers,
|
||||||
|
buffer_size);
|
||||||
|
return offset;
|
||||||
|
}
|
||||||
|
/* if root_raw is NULL, then do a dry run, aka only calculate final offset */
|
||||||
|
unsigned int ipc_shm_encode_region(struct ipc_shm_raw_region *root_raw, uint32_t num_chans, uint32_t num_buffers,
|
||||||
|
uint32_t buffer_size)
|
||||||
|
{
|
||||||
|
unsigned i;
|
||||||
|
uintptr_t start = (uintptr_t)root_raw;
|
||||||
|
unsigned int offset = sizeof(struct ipc_shm_raw_region) + sizeof(uint32_t) * num_chans;
|
||||||
|
offset = (((uintptr_t)offset + 7) & ~0x07ULL);
|
||||||
|
|
||||||
|
if (root_raw)
|
||||||
|
root_raw->num_chans = num_chans;
|
||||||
|
for (i = 0; i < num_chans; i++) {
|
||||||
|
uint32_t ofs = (start + offset - (uintptr_t)root_raw);
|
||||||
|
if (root_raw)
|
||||||
|
root_raw->chan_offset[i] = (start + offset - (uintptr_t)root_raw);
|
||||||
|
#ifdef ENCDECDEBUG
|
||||||
|
fprintf(stderr, "encode: channel %d chan_offset[i]=%u\n", i, ofs);
|
||||||
|
#endif
|
||||||
|
offset += ipc_shm_encode_channel(root_raw, (struct ipc_shm_raw_channel *)(start + offset), num_buffers,
|
||||||
|
buffer_size);
|
||||||
|
}
|
||||||
|
//TODO: pass maximum size and verify we didn't go through
|
||||||
|
return offset;
|
||||||
|
}
|
||||||
224
Transceiver52M/device/ipc/shm.h
Normal file
224
Transceiver52M/device/ipc/shm.h
Normal file
@@ -0,0 +1,224 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Pau Espin Pedrol <pespin@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
#pragma once
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <limits.h>
|
||||||
|
//#include <pthread.h>
|
||||||
|
#include <semaphore.h>
|
||||||
|
|
||||||
|
/* RAW structures */
|
||||||
|
struct ipc_shm_raw_smpl_buf {
|
||||||
|
uint64_t timestamp;
|
||||||
|
uint32_t data_len; /* In samples */
|
||||||
|
uint16_t samples[0];
|
||||||
|
};
|
||||||
|
|
||||||
|
struct ipc_shm_raw_stream {
|
||||||
|
pthread_mutex_t lock;
|
||||||
|
pthread_cond_t cf;
|
||||||
|
pthread_cond_t ce;
|
||||||
|
uint32_t num_buffers;
|
||||||
|
uint32_t buffer_size; /* In samples */
|
||||||
|
uint32_t read_next;
|
||||||
|
uint32_t write_next;
|
||||||
|
uint32_t buffer_offset[0];
|
||||||
|
//struct ipc_shm_smpl_buf buffers[0];
|
||||||
|
};
|
||||||
|
|
||||||
|
struct ipc_shm_raw_channel {
|
||||||
|
uint32_t dl_buf_offset;
|
||||||
|
uint32_t ul_buf_offset;
|
||||||
|
};
|
||||||
|
|
||||||
|
struct ipc_shm_raw_region {
|
||||||
|
uint32_t num_chans;
|
||||||
|
uint32_t chan_offset[0];
|
||||||
|
};
|
||||||
|
|
||||||
|
/* non-raw, Pointer converted structures */
|
||||||
|
struct ipc_shm_stream {
|
||||||
|
uint32_t num_buffers;
|
||||||
|
uint32_t buffer_size;
|
||||||
|
volatile struct ipc_shm_raw_stream *raw;
|
||||||
|
volatile struct ipc_shm_raw_smpl_buf *buffers[0];
|
||||||
|
};
|
||||||
|
|
||||||
|
struct ipc_shm_channel {
|
||||||
|
struct ipc_shm_stream *dl_stream;
|
||||||
|
struct ipc_shm_stream *ul_stream;
|
||||||
|
};
|
||||||
|
|
||||||
|
/* Pointer converted structures */
|
||||||
|
struct ipc_shm_region {
|
||||||
|
uint32_t num_chans;
|
||||||
|
struct ipc_shm_channel *channels[0];
|
||||||
|
};
|
||||||
|
|
||||||
|
unsigned int ipc_shm_encode_region(struct ipc_shm_raw_region *root_raw, uint32_t num_chans, uint32_t num_buffers,
|
||||||
|
uint32_t buffer_size);
|
||||||
|
struct ipc_shm_region *ipc_shm_decode_region(void *tall_ctx, struct ipc_shm_raw_region *root_raw);
|
||||||
|
/****************************************/
|
||||||
|
/* UNIX SOCKET API */
|
||||||
|
/****************************************/
|
||||||
|
|
||||||
|
//////////////////
|
||||||
|
// Master socket
|
||||||
|
//////////////////
|
||||||
|
|
||||||
|
#define IPC_SOCK_PATH_PREFIX "/tmp/ipc_sock"
|
||||||
|
#define IPC_SOCK_API_VERSION 1
|
||||||
|
|
||||||
|
/* msg_type */
|
||||||
|
#define IPC_IF_MSG_GREETING_REQ 0x00
|
||||||
|
#define IPC_IF_MSG_GREETING_CNF 0x01
|
||||||
|
#define IPC_IF_MSG_INFO_REQ 0x02
|
||||||
|
#define IPC_IF_MSG_INFO_CNF 0x03
|
||||||
|
#define IPC_IF_MSG_OPEN_REQ 0x04
|
||||||
|
#define IPC_IF_MSG_OPEN_CNF 0x05
|
||||||
|
|
||||||
|
#define MAX_NUM_CHANS 30
|
||||||
|
#define RF_PATH_NAME_SIZE 25
|
||||||
|
#define MAX_NUM_RF_PATHS 10
|
||||||
|
#define SHM_NAME_MAX NAME_MAX /* 255 */
|
||||||
|
|
||||||
|
#define FEATURE_MASK_CLOCKREF_INTERNAL (0x1 << 0)
|
||||||
|
#define FEATURE_MASK_CLOCKREF_EXTERNAL (0x1 << 1)
|
||||||
|
struct ipc_sk_if_info_chan {
|
||||||
|
char tx_path[MAX_NUM_RF_PATHS][RF_PATH_NAME_SIZE];
|
||||||
|
char rx_path[MAX_NUM_RF_PATHS][RF_PATH_NAME_SIZE];
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_if_open_req_chan {
|
||||||
|
char tx_path[RF_PATH_NAME_SIZE];
|
||||||
|
char rx_path[RF_PATH_NAME_SIZE];
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_if_open_cnf_chan {
|
||||||
|
char chan_ipc_sk_path[108];
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_if_greeting {
|
||||||
|
uint8_t req_version;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_if_info_req {
|
||||||
|
uint8_t spare;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_if_info_cnf {
|
||||||
|
uint32_t feature_mask;
|
||||||
|
double min_rx_gain;
|
||||||
|
double max_rx_gain;
|
||||||
|
double min_tx_gain;
|
||||||
|
double max_tx_gain;
|
||||||
|
double iq_scaling_val_rx;
|
||||||
|
double iq_scaling_val_tx;
|
||||||
|
uint32_t max_num_chans;
|
||||||
|
char dev_desc[200];
|
||||||
|
struct ipc_sk_if_info_chan chan_info[0];
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_if_open_req {
|
||||||
|
uint32_t num_chans;
|
||||||
|
uint32_t clockref; /* One of FEATUER_MASK_CLOCKREF_* */
|
||||||
|
uint32_t rx_sample_freq_num;
|
||||||
|
uint32_t rx_sample_freq_den;
|
||||||
|
uint32_t tx_sample_freq_num;
|
||||||
|
uint32_t tx_sample_freq_den;
|
||||||
|
uint32_t bandwidth;
|
||||||
|
struct ipc_sk_if_open_req_chan chan_info[0];
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_if_open_cnf {
|
||||||
|
uint8_t return_code;
|
||||||
|
uint32_t path_delay;
|
||||||
|
char shm_name[SHM_NAME_MAX];
|
||||||
|
struct ipc_sk_if_open_cnf_chan chan_info[0];
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_if {
|
||||||
|
uint8_t msg_type; /* message type */
|
||||||
|
uint8_t spare[2];
|
||||||
|
|
||||||
|
union {
|
||||||
|
struct ipc_sk_if_greeting greeting_req;
|
||||||
|
struct ipc_sk_if_greeting greeting_cnf;
|
||||||
|
struct ipc_sk_if_info_req info_req;
|
||||||
|
struct ipc_sk_if_info_cnf info_cnf;
|
||||||
|
struct ipc_sk_if_open_req open_req;
|
||||||
|
struct ipc_sk_if_open_cnf open_cnf;
|
||||||
|
} u;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
//////////////////
|
||||||
|
// Channel socket
|
||||||
|
//////////////////
|
||||||
|
#define IPC_IF_CHAN_MSG_OFFSET 50
|
||||||
|
#define IPC_IF_MSG_START_REQ IPC_IF_CHAN_MSG_OFFSET + 0x00
|
||||||
|
#define IPC_IF_MSG_START_CNF IPC_IF_CHAN_MSG_OFFSET + 0x01
|
||||||
|
#define IPC_IF_MSG_STOP_REQ IPC_IF_CHAN_MSG_OFFSET + 0x02
|
||||||
|
#define IPC_IF_MSG_STOP_CNF IPC_IF_CHAN_MSG_OFFSET + 0x03
|
||||||
|
#define IPC_IF_MSG_SETGAIN_REQ IPC_IF_CHAN_MSG_OFFSET + 0x04
|
||||||
|
#define IPC_IF_MSG_SETGAIN_CNF IPC_IF_CHAN_MSG_OFFSET + 0x05
|
||||||
|
#define IPC_IF_MSG_SETFREQ_REQ IPC_IF_CHAN_MSG_OFFSET + 0x06
|
||||||
|
#define IPC_IF_MSG_SETFREQ_CNF IPC_IF_CHAN_MSG_OFFSET + 0x07
|
||||||
|
|
||||||
|
#define IPC_IF_NOTIFY_UNDERFLOW IPC_IF_CHAN_MSG_OFFSET + 0x08
|
||||||
|
#define IPC_IF_NOTIFY_OVERFLOW IPC_IF_CHAN_MSG_OFFSET + 0x09
|
||||||
|
|
||||||
|
struct ipc_sk_chan_if_op_void {
|
||||||
|
// at least one dummy byte, to allow c/c++ compatibility
|
||||||
|
uint8_t dummy;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_chan_if_op_rc {
|
||||||
|
uint8_t return_code;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_chan_if_gain {
|
||||||
|
double gain;
|
||||||
|
uint8_t is_tx;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_chan_if_freq_req {
|
||||||
|
double freq;
|
||||||
|
uint8_t is_tx;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_chan_if_freq_cnf {
|
||||||
|
uint8_t return_code;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_chan_if_notfiy {
|
||||||
|
uint8_t dummy;
|
||||||
|
} __attribute__((packed));
|
||||||
|
|
||||||
|
struct ipc_sk_chan_if {
|
||||||
|
uint8_t msg_type; /* message type */
|
||||||
|
uint8_t spare[2];
|
||||||
|
|
||||||
|
union {
|
||||||
|
struct ipc_sk_chan_if_op_void start_req;
|
||||||
|
struct ipc_sk_chan_if_op_rc start_cnf;
|
||||||
|
struct ipc_sk_chan_if_op_void stop_req;
|
||||||
|
struct ipc_sk_chan_if_op_rc stop_cnf;
|
||||||
|
struct ipc_sk_chan_if_gain set_gain_req;
|
||||||
|
struct ipc_sk_chan_if_gain set_gain_cnf;
|
||||||
|
struct ipc_sk_chan_if_freq_req set_freq_req;
|
||||||
|
struct ipc_sk_chan_if_freq_cnf set_freq_cnf;
|
||||||
|
struct ipc_sk_chan_if_notfiy notify;
|
||||||
|
} u;
|
||||||
|
} __attribute__((packed));
|
||||||
243
Transceiver52M/device/ipc/uhdwrap.cpp
Normal file
243
Transceiver52M/device/ipc/uhdwrap.cpp
Normal file
@@ -0,0 +1,243 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Eric Wild <ewild@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
extern "C" {
|
||||||
|
#include <osmocom/core/application.h>
|
||||||
|
#include <osmocom/core/talloc.h>
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
#include <osmocom/core/socket.h>
|
||||||
|
#include <osmocom/core/logging.h>
|
||||||
|
#include <osmocom/core/utils.h>
|
||||||
|
#include <osmocom/core/msgb.h>
|
||||||
|
#include <osmocom/core/select.h>
|
||||||
|
#include <osmocom/core/timer.h>
|
||||||
|
|
||||||
|
#include "shm.h"
|
||||||
|
#include "ipc_shm.h"
|
||||||
|
#include "ipc-driver-test.h"
|
||||||
|
}
|
||||||
|
#include "../uhd/UHDDevice.h"
|
||||||
|
#include "uhdwrap.h"
|
||||||
|
|
||||||
|
#include "trx_vty.h"
|
||||||
|
#include "Logger.h"
|
||||||
|
#include "Threads.h"
|
||||||
|
#include "Utils.h"
|
||||||
|
|
||||||
|
int uhd_wrap::open(const std::string &args, int ref, bool swap_channels)
|
||||||
|
{
|
||||||
|
int rv = uhd_device::open(args, ref, swap_channels);
|
||||||
|
samps_per_buff_rx = rx_stream->get_max_num_samps();
|
||||||
|
samps_per_buff_tx = tx_stream->get_max_num_samps();
|
||||||
|
channel_count = usrp_dev->get_rx_num_channels();
|
||||||
|
|
||||||
|
wrap_rx_buffs = std::vector<std::vector<short> >(channel_count, std::vector<short>(2 * samps_per_buff_rx));
|
||||||
|
for (size_t i = 0; i < wrap_rx_buffs.size(); i++)
|
||||||
|
wrap_rx_buf_ptrs.push_back(&wrap_rx_buffs[i].front());
|
||||||
|
|
||||||
|
wrap_tx_buffs = std::vector<std::vector<short> >(channel_count, std::vector<short>(2 * 5000));
|
||||||
|
for (size_t i = 0; i < wrap_tx_buffs.size(); i++)
|
||||||
|
wrap_tx_buf_ptrs.push_back(&wrap_tx_buffs[i].front());
|
||||||
|
|
||||||
|
return rv;
|
||||||
|
}
|
||||||
|
|
||||||
|
uhd_wrap::~uhd_wrap()
|
||||||
|
{
|
||||||
|
// drvtest::gshutdown = 1;
|
||||||
|
//t->join();
|
||||||
|
}
|
||||||
|
|
||||||
|
size_t uhd_wrap::bufsizerx()
|
||||||
|
{
|
||||||
|
return samps_per_buff_rx;
|
||||||
|
}
|
||||||
|
|
||||||
|
size_t uhd_wrap::bufsizetx()
|
||||||
|
{
|
||||||
|
return samps_per_buff_tx;
|
||||||
|
}
|
||||||
|
|
||||||
|
int uhd_wrap::chancount()
|
||||||
|
{
|
||||||
|
return channel_count;
|
||||||
|
}
|
||||||
|
|
||||||
|
int uhd_wrap::wrap_read(TIMESTAMP *timestamp)
|
||||||
|
{
|
||||||
|
uhd::rx_metadata_t md;
|
||||||
|
size_t num_rx_samps = rx_stream->recv(wrap_rx_buf_ptrs, samps_per_buff_rx, md, 0.1, true);
|
||||||
|
*timestamp = md.time_spec.to_ticks(rx_rate);
|
||||||
|
return num_rx_samps; //uhd_device::readSamples(bufs, len, overrun, timestamp, underrun);
|
||||||
|
}
|
||||||
|
|
||||||
|
extern "C" void *uhdwrap_open(struct ipc_sk_if_open_req *open_req)
|
||||||
|
{
|
||||||
|
unsigned int rx_sps, tx_sps;
|
||||||
|
|
||||||
|
/* FIXME: dev arg string* */
|
||||||
|
/* FIXME: rx frontend bw? */
|
||||||
|
/* FIXME: tx frontend bw? */
|
||||||
|
ReferenceType cref;
|
||||||
|
switch (open_req->clockref) {
|
||||||
|
case FEATURE_MASK_CLOCKREF_EXTERNAL:
|
||||||
|
cref = ReferenceType::REF_EXTERNAL;
|
||||||
|
break;
|
||||||
|
case FEATURE_MASK_CLOCKREF_INTERNAL:
|
||||||
|
default:
|
||||||
|
cref = ReferenceType::REF_INTERNAL;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
std::vector<std::string> tx_paths;
|
||||||
|
std::vector<std::string> rx_paths;
|
||||||
|
for (unsigned int i = 0; i < open_req->num_chans; i++) {
|
||||||
|
tx_paths.push_back(open_req->chan_info[i].tx_path);
|
||||||
|
rx_paths.push_back(open_req->chan_info[i].rx_path);
|
||||||
|
}
|
||||||
|
|
||||||
|
rx_sps = open_req->rx_sample_freq_num / open_req->rx_sample_freq_den;
|
||||||
|
tx_sps = open_req->tx_sample_freq_num / open_req->tx_sample_freq_den;
|
||||||
|
uhd_wrap *uhd_wrap_dev =
|
||||||
|
new uhd_wrap(tx_sps, rx_sps, RadioDevice::NORMAL, open_req->num_chans, 0.0, tx_paths, rx_paths);
|
||||||
|
uhd_wrap_dev->open("", cref, false);
|
||||||
|
|
||||||
|
return uhd_wrap_dev;
|
||||||
|
}
|
||||||
|
extern "C" int32_t uhdwrap_get_bufsizerx(void *dev)
|
||||||
|
{
|
||||||
|
uhd_wrap *d = (uhd_wrap *)dev;
|
||||||
|
return d->bufsizerx();
|
||||||
|
}
|
||||||
|
|
||||||
|
extern "C" int32_t uhdwrap_get_timingoffset(void *dev)
|
||||||
|
{
|
||||||
|
uhd_wrap *d = (uhd_wrap *)dev;
|
||||||
|
return d->getTimingOffset();
|
||||||
|
}
|
||||||
|
|
||||||
|
extern "C" int32_t uhdwrap_read(void *dev, uint32_t num_chans)
|
||||||
|
{
|
||||||
|
TIMESTAMP t;
|
||||||
|
uhd_wrap *d = (uhd_wrap *)dev;
|
||||||
|
|
||||||
|
if (num_chans != d->wrap_rx_buf_ptrs.size()) {
|
||||||
|
perror("omg chans?!");
|
||||||
|
}
|
||||||
|
|
||||||
|
int32_t read = d->wrap_read(&t);
|
||||||
|
if (read < 0)
|
||||||
|
return read;
|
||||||
|
|
||||||
|
for (uint32_t i = 0; i < num_chans; i++) {
|
||||||
|
ipc_shm_enqueue(ios_rx_from_device[i], t, read, (uint16_t *)&d->wrap_rx_buffs[i].front());
|
||||||
|
}
|
||||||
|
return read;
|
||||||
|
}
|
||||||
|
|
||||||
|
extern "C" int32_t uhdwrap_write(void *dev, uint32_t num_chans, bool *underrun)
|
||||||
|
{
|
||||||
|
uhd_wrap *d = (uhd_wrap *)dev;
|
||||||
|
|
||||||
|
uint64_t timestamp;
|
||||||
|
int32_t len;
|
||||||
|
for (uint32_t i = 0; i < num_chans; i++) {
|
||||||
|
len = ipc_shm_read(ios_tx_to_device[i], (uint16_t *)&d->wrap_tx_buffs[i].front(), 5000, ×tamp, 1);
|
||||||
|
if (len < 0)
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
return d->writeSamples(d->wrap_tx_buf_ptrs, len, underrun, timestamp);
|
||||||
|
}
|
||||||
|
|
||||||
|
extern "C" double uhdwrap_set_freq(void *dev, double f, size_t chan, bool for_tx)
|
||||||
|
{
|
||||||
|
uhd_wrap *d = (uhd_wrap *)dev;
|
||||||
|
if (for_tx)
|
||||||
|
return d->setTxFreq(f, chan);
|
||||||
|
else
|
||||||
|
return d->setRxFreq(f, chan);
|
||||||
|
}
|
||||||
|
|
||||||
|
extern "C" double uhdwrap_set_gain(void *dev, double f, size_t chan, bool for_tx)
|
||||||
|
{
|
||||||
|
uhd_wrap *d = (uhd_wrap *)dev;
|
||||||
|
if (for_tx)
|
||||||
|
return d->setTxGain(f, chan);
|
||||||
|
else
|
||||||
|
return d->setRxGain(f, chan);
|
||||||
|
}
|
||||||
|
|
||||||
|
extern "C" int32_t uhdwrap_start(void *dev, int chan)
|
||||||
|
{
|
||||||
|
uhd_wrap *d = (uhd_wrap *)dev;
|
||||||
|
return d->start();
|
||||||
|
}
|
||||||
|
|
||||||
|
extern "C" int32_t uhdwrap_stop(void *dev, int chan)
|
||||||
|
{
|
||||||
|
uhd_wrap *d = (uhd_wrap *)dev;
|
||||||
|
return d->stop();
|
||||||
|
}
|
||||||
|
|
||||||
|
extern "C" void uhdwrap_fill_info_cnf(struct ipc_sk_if *ipc_prim)
|
||||||
|
{
|
||||||
|
struct ipc_sk_if_info_chan *chan_info;
|
||||||
|
|
||||||
|
uhd::device_addr_t args("");
|
||||||
|
uhd::device_addrs_t devs_found = uhd::device::find(args);
|
||||||
|
if (devs_found.size() < 1) {
|
||||||
|
std::cout << "\n No device found!";
|
||||||
|
exit(0);
|
||||||
|
}
|
||||||
|
|
||||||
|
uhd::usrp::multi_usrp::sptr usrp = uhd::usrp::multi_usrp::make(devs_found[0]);
|
||||||
|
auto rxchans = usrp->get_rx_num_channels();
|
||||||
|
auto txchans = usrp->get_tx_num_channels();
|
||||||
|
auto rx_range = usrp->get_rx_gain_range();
|
||||||
|
auto tx_range = usrp->get_tx_gain_range();
|
||||||
|
|
||||||
|
//auto nboards = usrp->get_num_mboards();
|
||||||
|
auto refs = usrp->get_clock_sources(0);
|
||||||
|
auto devname = usrp->get_mboard_name(0);
|
||||||
|
|
||||||
|
ipc_prim->u.info_cnf.feature_mask = 0;
|
||||||
|
if (std::find(refs.begin(), refs.end(), "internal") != refs.end())
|
||||||
|
ipc_prim->u.info_cnf.feature_mask |= FEATURE_MASK_CLOCKREF_INTERNAL;
|
||||||
|
if (std::find(refs.begin(), refs.end(), "external") != refs.end())
|
||||||
|
ipc_prim->u.info_cnf.feature_mask |= FEATURE_MASK_CLOCKREF_EXTERNAL;
|
||||||
|
|
||||||
|
// at least one duplex channel
|
||||||
|
auto num_chans = rxchans == txchans ? txchans : 1;
|
||||||
|
|
||||||
|
ipc_prim->u.info_cnf.min_rx_gain = rx_range.start();
|
||||||
|
ipc_prim->u.info_cnf.max_rx_gain = rx_range.stop();
|
||||||
|
ipc_prim->u.info_cnf.min_tx_gain = tx_range.start();
|
||||||
|
ipc_prim->u.info_cnf.max_tx_gain = tx_range.stop();
|
||||||
|
ipc_prim->u.info_cnf.iq_scaling_val_rx = 0.3;
|
||||||
|
ipc_prim->u.info_cnf.iq_scaling_val_tx = 1;
|
||||||
|
ipc_prim->u.info_cnf.max_num_chans = num_chans;
|
||||||
|
OSMO_STRLCPY_ARRAY(ipc_prim->u.info_cnf.dev_desc, devname.c_str());
|
||||||
|
chan_info = ipc_prim->u.info_cnf.chan_info;
|
||||||
|
for (unsigned int i = 0; i < ipc_prim->u.info_cnf.max_num_chans; i++) {
|
||||||
|
auto rxant = usrp->get_rx_antennas(i);
|
||||||
|
auto txant = usrp->get_tx_antennas(i);
|
||||||
|
for (unsigned int j = 0; j < txant.size(); j++) {
|
||||||
|
OSMO_STRLCPY_ARRAY(chan_info->tx_path[j], txant[j].c_str());
|
||||||
|
}
|
||||||
|
for (unsigned int j = 0; j < rxant.size(); j++) {
|
||||||
|
OSMO_STRLCPY_ARRAY(chan_info->rx_path[j], rxant[j].c_str());
|
||||||
|
}
|
||||||
|
chan_info++;
|
||||||
|
}
|
||||||
|
}
|
||||||
79
Transceiver52M/device/ipc/uhdwrap.h
Normal file
79
Transceiver52M/device/ipc/uhdwrap.h
Normal file
@@ -0,0 +1,79 @@
|
|||||||
|
/*
|
||||||
|
* Copyright 2020 sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
|
||||||
|
* Author: Eric Wild <ewild@sysmocom.de>
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: 0BSD
|
||||||
|
*
|
||||||
|
Permission to use, copy, modify, and/or distribute this software for any purpose with or without fee is hereby granted.
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL
|
||||||
|
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT,
|
||||||
|
INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN
|
||||||
|
AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||||
|
PERFORMANCE OF THIS SOFTWARE.
|
||||||
|
*/
|
||||||
|
#ifndef IPC_UHDWRAP_H
|
||||||
|
#define IPC_UHDWRAP_H
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
#include "../uhd/UHDDevice.h"
|
||||||
|
|
||||||
|
class uhd_wrap : public uhd_device {
|
||||||
|
public:
|
||||||
|
// std::thread *t;
|
||||||
|
size_t samps_per_buff_rx;
|
||||||
|
size_t samps_per_buff_tx;
|
||||||
|
int channel_count;
|
||||||
|
|
||||||
|
std::vector<std::vector<short> > wrap_rx_buffs;
|
||||||
|
std::vector<std::vector<short> > wrap_tx_buffs;
|
||||||
|
std::vector<short *> wrap_rx_buf_ptrs;
|
||||||
|
std::vector<short *> wrap_tx_buf_ptrs;
|
||||||
|
|
||||||
|
template <typename... Args> uhd_wrap(Args... args) : uhd_device(args...)
|
||||||
|
{
|
||||||
|
// t = new std::thread(magicthread);
|
||||||
|
// give the thread some time to start and set up
|
||||||
|
// std::this_thread::sleep_for(std::chrono::seconds(1));
|
||||||
|
}
|
||||||
|
virtual ~uhd_wrap();
|
||||||
|
|
||||||
|
// void ipc_sock_close() override {};
|
||||||
|
int wrap_read(TIMESTAMP *timestamp);
|
||||||
|
virtual int open(const std::string &args, int ref, bool swap_channels) override;
|
||||||
|
|
||||||
|
// bool start() override;
|
||||||
|
// bool stop() override;
|
||||||
|
// virtual TIMESTAMP initialWriteTimestamp() override;
|
||||||
|
// virtual TIMESTAMP initialReadTimestamp() override;
|
||||||
|
|
||||||
|
int getTimingOffset()
|
||||||
|
{
|
||||||
|
return ts_offset;
|
||||||
|
}
|
||||||
|
size_t bufsizerx();
|
||||||
|
size_t bufsizetx();
|
||||||
|
int chancount();
|
||||||
|
};
|
||||||
|
#else
|
||||||
|
void *uhdwrap_open(struct ipc_sk_if_open_req *open_req);
|
||||||
|
|
||||||
|
int32_t uhdwrap_get_bufsizerx(void *dev);
|
||||||
|
|
||||||
|
int32_t uhdwrap_get_timingoffset(void *dev);
|
||||||
|
|
||||||
|
int32_t uhdwrap_read(void *dev, uint32_t num_chans);
|
||||||
|
|
||||||
|
int32_t uhdwrap_write(void *dev, uint32_t num_chans, bool *underrun);
|
||||||
|
|
||||||
|
double uhdwrap_set_freq(void *dev, double f, size_t chan, bool for_tx);
|
||||||
|
|
||||||
|
double uhdwrap_set_gain(void *dev, double f, size_t chan, bool for_tx);
|
||||||
|
|
||||||
|
int32_t uhdwrap_start(void *dev, int chan);
|
||||||
|
|
||||||
|
int32_t uhdwrap_stop(void *dev, int chan);
|
||||||
|
|
||||||
|
void uhdwrap_fill_info_cnf(struct ipc_sk_if *ipc_prim);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif // IPC_B210_H
|
||||||
@@ -1202,6 +1202,7 @@ std::string uhd_device::str_code(uhd::async_metadata_t metadata)
|
|||||||
return ost.str();
|
return ost.str();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#ifndef IPCMAGIC
|
||||||
RadioDevice *RadioDevice::make(size_t tx_sps, size_t rx_sps,
|
RadioDevice *RadioDevice::make(size_t tx_sps, size_t rx_sps,
|
||||||
InterfaceType iface, size_t chans, double lo_offset,
|
InterfaceType iface, size_t chans, double lo_offset,
|
||||||
const std::vector<std::string>& tx_paths,
|
const std::vector<std::string>& tx_paths,
|
||||||
@@ -1209,3 +1210,4 @@ RadioDevice *RadioDevice::make(size_t tx_sps, size_t rx_sps,
|
|||||||
{
|
{
|
||||||
return new uhd_device(tx_sps, rx_sps, iface, chans, lo_offset, tx_paths, rx_paths);
|
return new uhd_device(tx_sps, rx_sps, iface, chans, lo_offset, tx_paths, rx_paths);
|
||||||
}
|
}
|
||||||
|
#endif
|
||||||
|
|||||||
@@ -127,7 +127,7 @@ public:
|
|||||||
ERROR_UNHANDLED = -4,
|
ERROR_UNHANDLED = -4,
|
||||||
};
|
};
|
||||||
|
|
||||||
private:
|
protected:
|
||||||
uhd::usrp::multi_usrp::sptr usrp_dev;
|
uhd::usrp::multi_usrp::sptr usrp_dev;
|
||||||
uhd::tx_streamer::sptr tx_stream;
|
uhd::tx_streamer::sptr tx_stream;
|
||||||
uhd::rx_streamer::sptr rx_stream;
|
uhd::rx_streamer::sptr rx_stream;
|
||||||
|
|||||||
@@ -324,6 +324,7 @@ AC_CONFIG_FILES([\
|
|||||||
Transceiver52M/device/uhd/Makefile \
|
Transceiver52M/device/uhd/Makefile \
|
||||||
Transceiver52M/device/usrp1/Makefile \
|
Transceiver52M/device/usrp1/Makefile \
|
||||||
Transceiver52M/device/lms/Makefile \
|
Transceiver52M/device/lms/Makefile \
|
||||||
|
Transceiver52M/device/ipc/Makefile \
|
||||||
tests/Makefile \
|
tests/Makefile \
|
||||||
tests/CommonLibs/Makefile \
|
tests/CommonLibs/Makefile \
|
||||||
tests/Transceiver52M/Makefile \
|
tests/Transceiver52M/Makefile \
|
||||||
|
|||||||
Reference in New Issue
Block a user