convert to using submodules #1
|
@ -0,0 +1,43 @@
|
|||
Makefile
|
||||
Makefile.in
|
||||
.deps
|
||||
.libs
|
||||
*.o
|
||||
*.lo
|
||||
*.la
|
||||
*.pc
|
||||
aclocal.m4
|
||||
acinclude.m4
|
||||
aminclude.am
|
||||
m4/*.m4
|
||||
autom4te.cache
|
||||
compile
|
||||
config.h*
|
||||
config.sub
|
||||
config.log
|
||||
config.status
|
||||
config.guess
|
||||
configure
|
||||
depcomp
|
||||
missing
|
||||
ltmain.sh
|
||||
install-sh
|
||||
stamp-h1
|
||||
libtool
|
||||
|
||||
.tarball-version
|
||||
.version
|
||||
.dirstamp
|
||||
|
||||
Doxyfile
|
||||
|
||||
.*.sw?
|
||||
|
||||
src/libdebug/libdebug.a
|
||||
src/liboptions/liboptions.a
|
||||
src/libsample/libsample.a
|
||||
src/libfilter/libfilter.a
|
||||
src/libwave/libwave.a
|
||||
src/libdisplay/libdisplay.a
|
||||
src/libsound/libsound.a
|
||||
src/uk0/uk0-soundcard
|
|
@ -0,0 +1,3 @@
|
|||
[submodule "src/lib"]
|
||||
path = src/lib
|
||||
url = https://gitea.osmocom.org/cellular-infrastructure/osmocom-analog-libraries.git
|
|
@ -0,0 +1,674 @@
|
|||
GNU GENERAL PUBLIC LICENSE
|
||||
Version 3, 29 June 2007
|
||||
|
||||
Copyright (C) 2007 Free Software Foundation, Inc. <http://fsf.org/>
|
||||
Everyone is permitted to copy and distribute verbatim copies
|
||||
of this license document, but changing it is not allowed.
|
||||
|
||||
Preamble
|
||||
|
||||
The GNU General Public License is a free, copyleft license for
|
||||
software and other kinds of works.
|
||||
|
||||
The licenses for most software and other practical works are designed
|
||||
to take away your freedom to share and change the works. By contrast,
|
||||
the GNU General Public License is intended to guarantee your freedom to
|
||||
share and change all versions of a program--to make sure it remains free
|
||||
software for all its users. We, the Free Software Foundation, use the
|
||||
GNU General Public License for most of our software; it applies also to
|
||||
any other work released this way by its authors. You can apply it to
|
||||
your programs, too.
|
||||
|
||||
When we speak of free software, we are referring to freedom, not
|
||||
price. Our General Public Licenses are designed to make sure that you
|
||||
have the freedom to distribute copies of free software (and charge for
|
||||
them if you wish), that you receive source code or can get it if you
|
||||
want it, that you can change the software or use pieces of it in new
|
||||
free programs, and that you know you can do these things.
|
||||
|
||||
To protect your rights, we need to prevent others from denying you
|
||||
these rights or asking you to surrender the rights. Therefore, you have
|
||||
certain responsibilities if you distribute copies of the software, or if
|
||||
you modify it: responsibilities to respect the freedom of others.
|
||||
|
||||
For example, if you distribute copies of such a program, whether
|
||||
gratis or for a fee, you must pass on to the recipients the same
|
||||
freedoms that you received. You must make sure that they, too, receive
|
||||
or can get the source code. And you must show them these terms so they
|
||||
know their rights.
|
||||
|
||||
Developers that use the GNU GPL protect your rights with two steps:
|
||||
(1) assert copyright on the software, and (2) offer you this License
|
||||
giving you legal permission to copy, distribute and/or modify it.
|
||||
|
||||
For the developers' and authors' protection, the GPL clearly explains
|
||||
that there is no warranty for this free software. For both users' and
|
||||
authors' sake, the GPL requires that modified versions be marked as
|
||||
changed, so that their problems will not be attributed erroneously to
|
||||
authors of previous versions.
|
||||
|
||||
Some devices are designed to deny users access to install or run
|
||||
modified versions of the software inside them, although the manufacturer
|
||||
can do so. This is fundamentally incompatible with the aim of
|
||||
protecting users' freedom to change the software. The systematic
|
||||
pattern of such abuse occurs in the area of products for individuals to
|
||||
use, which is precisely where it is most unacceptable. Therefore, we
|
||||
have designed this version of the GPL to prohibit the practice for those
|
||||
products. If such problems arise substantially in other domains, we
|
||||
stand ready to extend this provision to those domains in future versions
|
||||
of the GPL, as needed to protect the freedom of users.
|
||||
|
||||
Finally, every program is threatened constantly by software patents.
|
||||
States should not allow patents to restrict development and use of
|
||||
software on general-purpose computers, but in those that do, we wish to
|
||||
avoid the special danger that patents applied to a free program could
|
||||
make it effectively proprietary. To prevent this, the GPL assures that
|
||||
patents cannot be used to render the program non-free.
|
||||
|
||||
The precise terms and conditions for copying, distribution and
|
||||
modification follow.
|
||||
|
||||
TERMS AND CONDITIONS
|
||||
|
||||
0. Definitions.
|
||||
|
||||
"This License" refers to version 3 of the GNU General Public License.
|
||||
|
||||
"Copyright" also means copyright-like laws that apply to other kinds of
|
||||
works, such as semiconductor masks.
|
||||
|
||||
"The Program" refers to any copyrightable work licensed under this
|
||||
License. Each licensee is addressed as "you". "Licensees" and
|
||||
"recipients" may be individuals or organizations.
|
||||
|
||||
To "modify" a work means to copy from or adapt all or part of the work
|
||||
in a fashion requiring copyright permission, other than the making of an
|
||||
exact copy. The resulting work is called a "modified version" of the
|
||||
earlier work or a work "based on" the earlier work.
|
||||
|
||||
A "covered work" means either the unmodified Program or a work based
|
||||
on the Program.
|
||||
|
||||
To "propagate" a work means to do anything with it that, without
|
||||
permission, would make you directly or secondarily liable for
|
||||
infringement under applicable copyright law, except executing it on a
|
||||
computer or modifying a private copy. Propagation includes copying,
|
||||
distribution (with or without modification), making available to the
|
||||
public, and in some countries other activities as well.
|
||||
|
||||
To "convey" a work means any kind of propagation that enables other
|
||||
parties to make or receive copies. Mere interaction with a user through
|
||||
a computer network, with no transfer of a copy, is not conveying.
|
||||
|
||||
An interactive user interface displays "Appropriate Legal Notices"
|
||||
to the extent that it includes a convenient and prominently visible
|
||||
feature that (1) displays an appropriate copyright notice, and (2)
|
||||
tells the user that there is no warranty for the work (except to the
|
||||
extent that warranties are provided), that licensees may convey the
|
||||
work under this License, and how to view a copy of this License. If
|
||||
the interface presents a list of user commands or options, such as a
|
||||
menu, a prominent item in the list meets this criterion.
|
||||
|
||||
1. Source Code.
|
||||
|
||||
The "source code" for a work means the preferred form of the work
|
||||
for making modifications to it. "Object code" means any non-source
|
||||
form of a work.
|
||||
|
||||
A "Standard Interface" means an interface that either is an official
|
||||
standard defined by a recognized standards body, or, in the case of
|
||||
interfaces specified for a particular programming language, one that
|
||||
is widely used among developers working in that language.
|
||||
|
||||
The "System Libraries" of an executable work include anything, other
|
||||
than the work as a whole, that (a) is included in the normal form of
|
||||
packaging a Major Component, but which is not part of that Major
|
||||
Component, and (b) serves only to enable use of the work with that
|
||||
Major Component, or to implement a Standard Interface for which an
|
||||
implementation is available to the public in source code form. A
|
||||
"Major Component", in this context, means a major essential component
|
||||
(kernel, window system, and so on) of the specific operating system
|
||||
(if any) on which the executable work runs, or a compiler used to
|
||||
produce the work, or an object code interpreter used to run it.
|
||||
|
||||
The "Corresponding Source" for a work in object code form means all
|
||||
the source code needed to generate, install, and (for an executable
|
||||
work) run the object code and to modify the work, including scripts to
|
||||
control those activities. However, it does not include the work's
|
||||
System Libraries, or general-purpose tools or generally available free
|
||||
programs which are used unmodified in performing those activities but
|
||||
which are not part of the work. For example, Corresponding Source
|
||||
includes interface definition files associated with source files for
|
||||
the work, and the source code for shared libraries and dynamically
|
||||
linked subprograms that the work is specifically designed to require,
|
||||
such as by intimate data communication or control flow between those
|
||||
subprograms and other parts of the work.
|
||||
|
||||
The Corresponding Source need not include anything that users
|
||||
can regenerate automatically from other parts of the Corresponding
|
||||
Source.
|
||||
|
||||
The Corresponding Source for a work in source code form is that
|
||||
same work.
|
||||
|
||||
2. Basic Permissions.
|
||||
|
||||
All rights granted under this License are granted for the term of
|
||||
copyright on the Program, and are irrevocable provided the stated
|
||||
conditions are met. This License explicitly affirms your unlimited
|
||||
permission to run the unmodified Program. The output from running a
|
||||
covered work is covered by this License only if the output, given its
|
||||
content, constitutes a covered work. This License acknowledges your
|
||||
rights of fair use or other equivalent, as provided by copyright law.
|
||||
|
||||
You may make, run and propagate covered works that you do not
|
||||
convey, without conditions so long as your license otherwise remains
|
||||
in force. You may convey covered works to others for the sole purpose
|
||||
of having them make modifications exclusively for you, or provide you
|
||||
with facilities for running those works, provided that you comply with
|
||||
the terms of this License in conveying all material for which you do
|
||||
not control copyright. Those thus making or running the covered works
|
||||
for you must do so exclusively on your behalf, under your direction
|
||||
and control, on terms that prohibit them from making any copies of
|
||||
your copyrighted material outside their relationship with you.
|
||||
|
||||
Conveying under any other circumstances is permitted solely under
|
||||
the conditions stated below. Sublicensing is not allowed; section 10
|
||||
makes it unnecessary.
|
||||
|
||||
3. Protecting Users' Legal Rights From Anti-Circumvention Law.
|
||||
|
||||
No covered work shall be deemed part of an effective technological
|
||||
measure under any applicable law fulfilling obligations under article
|
||||
11 of the WIPO copyright treaty adopted on 20 December 1996, or
|
||||
similar laws prohibiting or restricting circumvention of such
|
||||
measures.
|
||||
|
||||
When you convey a covered work, you waive any legal power to forbid
|
||||
circumvention of technological measures to the extent such circumvention
|
||||
is effected by exercising rights under this License with respect to
|
||||
the covered work, and you disclaim any intention to limit operation or
|
||||
modification of the work as a means of enforcing, against the work's
|
||||
users, your or third parties' legal rights to forbid circumvention of
|
||||
technological measures.
|
||||
|
||||
4. Conveying Verbatim Copies.
|
||||
|
||||
You may convey verbatim copies of the Program's source code as you
|
||||
receive it, in any medium, provided that you conspicuously and
|
||||
appropriately publish on each copy an appropriate copyright notice;
|
||||
keep intact all notices stating that this License and any
|
||||
non-permissive terms added in accord with section 7 apply to the code;
|
||||
keep intact all notices of the absence of any warranty; and give all
|
||||
recipients a copy of this License along with the Program.
|
||||
|
||||
You may charge any price or no price for each copy that you convey,
|
||||
and you may offer support or warranty protection for a fee.
|
||||
|
||||
5. Conveying Modified Source Versions.
|
||||
|
||||
You may convey a work based on the Program, or the modifications to
|
||||
produce it from the Program, in the form of source code under the
|
||||
terms of section 4, provided that you also meet all of these conditions:
|
||||
|
||||
a) The work must carry prominent notices stating that you modified
|
||||
it, and giving a relevant date.
|
||||
|
||||
b) The work must carry prominent notices stating that it is
|
||||
released under this License and any conditions added under section
|
||||
7. This requirement modifies the requirement in section 4 to
|
||||
"keep intact all notices".
|
||||
|
||||
c) You must license the entire work, as a whole, under this
|
||||
License to anyone who comes into possession of a copy. This
|
||||
License will therefore apply, along with any applicable section 7
|
||||
additional terms, to the whole of the work, and all its parts,
|
||||
regardless of how they are packaged. This License gives no
|
||||
permission to license the work in any other way, but it does not
|
||||
invalidate such permission if you have separately received it.
|
||||
|
||||
d) If the work has interactive user interfaces, each must display
|
||||
Appropriate Legal Notices; however, if the Program has interactive
|
||||
interfaces that do not display Appropriate Legal Notices, your
|
||||
work need not make them do so.
|
||||
|
||||
A compilation of a covered work with other separate and independent
|
||||
works, which are not by their nature extensions of the covered work,
|
||||
and which are not combined with it such as to form a larger program,
|
||||
in or on a volume of a storage or distribution medium, is called an
|
||||
"aggregate" if the compilation and its resulting copyright are not
|
||||
used to limit the access or legal rights of the compilation's users
|
||||
beyond what the individual works permit. Inclusion of a covered work
|
||||
in an aggregate does not cause this License to apply to the other
|
||||
parts of the aggregate.
|
||||
|
||||
6. Conveying Non-Source Forms.
|
||||
|
||||
You may convey a covered work in object code form under the terms
|
||||
of sections 4 and 5, provided that you also convey the
|
||||
machine-readable Corresponding Source under the terms of this License,
|
||||
in one of these ways:
|
||||
|
||||
a) Convey the object code in, or embodied in, a physical product
|
||||
(including a physical distribution medium), accompanied by the
|
||||
Corresponding Source fixed on a durable physical medium
|
||||
customarily used for software interchange.
|
||||
|
||||
b) Convey the object code in, or embodied in, a physical product
|
||||
(including a physical distribution medium), accompanied by a
|
||||
written offer, valid for at least three years and valid for as
|
||||
long as you offer spare parts or customer support for that product
|
||||
model, to give anyone who possesses the object code either (1) a
|
||||
copy of the Corresponding Source for all the software in the
|
||||
product that is covered by this License, on a durable physical
|
||||
medium customarily used for software interchange, for a price no
|
||||
more than your reasonable cost of physically performing this
|
||||
conveying of source, or (2) access to copy the
|
||||
Corresponding Source from a network server at no charge.
|
||||
|
||||
c) Convey individual copies of the object code with a copy of the
|
||||
written offer to provide the Corresponding Source. This
|
||||
alternative is allowed only occasionally and noncommercially, and
|
||||
only if you received the object code with such an offer, in accord
|
||||
with subsection 6b.
|
||||
|
||||
d) Convey the object code by offering access from a designated
|
||||
place (gratis or for a charge), and offer equivalent access to the
|
||||
Corresponding Source in the same way through the same place at no
|
||||
further charge. You need not require recipients to copy the
|
||||
Corresponding Source along with the object code. If the place to
|
||||
copy the object code is a network server, the Corresponding Source
|
||||
may be on a different server (operated by you or a third party)
|
||||
that supports equivalent copying facilities, provided you maintain
|
||||
clear directions next to the object code saying where to find the
|
||||
Corresponding Source. Regardless of what server hosts the
|
||||
Corresponding Source, you remain obligated to ensure that it is
|
||||
available for as long as needed to satisfy these requirements.
|
||||
|
||||
e) Convey the object code using peer-to-peer transmission, provided
|
||||
you inform other peers where the object code and Corresponding
|
||||
Source of the work are being offered to the general public at no
|
||||
charge under subsection 6d.
|
||||
|
||||
A separable portion of the object code, whose source code is excluded
|
||||
from the Corresponding Source as a System Library, need not be
|
||||
included in conveying the object code work.
|
||||
|
||||
A "User Product" is either (1) a "consumer product", which means any
|
||||
tangible personal property which is normally used for personal, family,
|
||||
or household purposes, or (2) anything designed or sold for incorporation
|
||||
into a dwelling. In determining whether a product is a consumer product,
|
||||
doubtful cases shall be resolved in favor of coverage. For a particular
|
||||
product received by a particular user, "normally used" refers to a
|
||||
typical or common use of that class of product, regardless of the status
|
||||
of the particular user or of the way in which the particular user
|
||||
actually uses, or expects or is expected to use, the product. A product
|
||||
is a consumer product regardless of whether the product has substantial
|
||||
commercial, industrial or non-consumer uses, unless such uses represent
|
||||
the only significant mode of use of the product.
|
||||
|
||||
"Installation Information" for a User Product means any methods,
|
||||
procedures, authorization keys, or other information required to install
|
||||
and execute modified versions of a covered work in that User Product from
|
||||
a modified version of its Corresponding Source. The information must
|
||||
suffice to ensure that the continued functioning of the modified object
|
||||
code is in no case prevented or interfered with solely because
|
||||
modification has been made.
|
||||
|
||||
If you convey an object code work under this section in, or with, or
|
||||
specifically for use in, a User Product, and the conveying occurs as
|
||||
part of a transaction in which the right of possession and use of the
|
||||
User Product is transferred to the recipient in perpetuity or for a
|
||||
fixed term (regardless of how the transaction is characterized), the
|
||||
Corresponding Source conveyed under this section must be accompanied
|
||||
by the Installation Information. But this requirement does not apply
|
||||
if neither you nor any third party retains the ability to install
|
||||
modified object code on the User Product (for example, the work has
|
||||
been installed in ROM).
|
||||
|
||||
The requirement to provide Installation Information does not include a
|
||||
requirement to continue to provide support service, warranty, or updates
|
||||
for a work that has been modified or installed by the recipient, or for
|
||||
the User Product in which it has been modified or installed. Access to a
|
||||
network may be denied when the modification itself materially and
|
||||
adversely affects the operation of the network or violates the rules and
|
||||
protocols for communication across the network.
|
||||
|
||||
Corresponding Source conveyed, and Installation Information provided,
|
||||
in accord with this section must be in a format that is publicly
|
||||
documented (and with an implementation available to the public in
|
||||
source code form), and must require no special password or key for
|
||||
unpacking, reading or copying.
|
||||
|
||||
7. Additional Terms.
|
||||
|
||||
"Additional permissions" are terms that supplement the terms of this
|
||||
License by making exceptions from one or more of its conditions.
|
||||
Additional permissions that are applicable to the entire Program shall
|
||||
be treated as though they were included in this License, to the extent
|
||||
that they are valid under applicable law. If additional permissions
|
||||
apply only to part of the Program, that part may be used separately
|
||||
under those permissions, but the entire Program remains governed by
|
||||
this License without regard to the additional permissions.
|
||||
|
||||
When you convey a copy of a covered work, you may at your option
|
||||
remove any additional permissions from that copy, or from any part of
|
||||
it. (Additional permissions may be written to require their own
|
||||
removal in certain cases when you modify the work.) You may place
|
||||
additional permissions on material, added by you to a covered work,
|
||||
for which you have or can give appropriate copyright permission.
|
||||
|
||||
Notwithstanding any other provision of this License, for material you
|
||||
add to a covered work, you may (if authorized by the copyright holders of
|
||||
that material) supplement the terms of this License with terms:
|
||||
|
||||
a) Disclaiming warranty or limiting liability differently from the
|
||||
terms of sections 15 and 16 of this License; or
|
||||
|
||||
b) Requiring preservation of specified reasonable legal notices or
|
||||
author attributions in that material or in the Appropriate Legal
|
||||
Notices displayed by works containing it; or
|
||||
|
||||
c) Prohibiting misrepresentation of the origin of that material, or
|
||||
requiring that modified versions of such material be marked in
|
||||
reasonable ways as different from the original version; or
|
||||
|
||||
d) Limiting the use for publicity purposes of names of licensors or
|
||||
authors of the material; or
|
||||
|
||||
e) Declining to grant rights under trademark law for use of some
|
||||
trade names, trademarks, or service marks; or
|
||||
|
||||
f) Requiring indemnification of licensors and authors of that
|
||||
material by anyone who conveys the material (or modified versions of
|
||||
it) with contractual assumptions of liability to the recipient, for
|
||||
any liability that these contractual assumptions directly impose on
|
||||
those licensors and authors.
|
||||
|
||||
All other non-permissive additional terms are considered "further
|
||||
restrictions" within the meaning of section 10. If the Program as you
|
||||
received it, or any part of it, contains a notice stating that it is
|
||||
governed by this License along with a term that is a further
|
||||
restriction, you may remove that term. If a license document contains
|
||||
a further restriction but permits relicensing or conveying under this
|
||||
License, you may add to a covered work material governed by the terms
|
||||
of that license document, provided that the further restriction does
|
||||
not survive such relicensing or conveying.
|
||||
|
||||
If you add terms to a covered work in accord with this section, you
|
||||
must place, in the relevant source files, a statement of the
|
||||
additional terms that apply to those files, or a notice indicating
|
||||
where to find the applicable terms.
|
||||
|
||||
Additional terms, permissive or non-permissive, may be stated in the
|
||||
form of a separately written license, or stated as exceptions;
|
||||
the above requirements apply either way.
|
||||
|
||||
8. Termination.
|
||||
|
||||
You may not propagate or modify a covered work except as expressly
|
||||
provided under this License. Any attempt otherwise to propagate or
|
||||
modify it is void, and will automatically terminate your rights under
|
||||
this License (including any patent licenses granted under the third
|
||||
paragraph of section 11).
|
||||
|
||||
However, if you cease all violation of this License, then your
|
||||
license from a particular copyright holder is reinstated (a)
|
||||
provisionally, unless and until the copyright holder explicitly and
|
||||
finally terminates your license, and (b) permanently, if the copyright
|
||||
holder fails to notify you of the violation by some reasonable means
|
||||
prior to 60 days after the cessation.
|
||||
|
||||
Moreover, your license from a particular copyright holder is
|
||||
reinstated permanently if the copyright holder notifies you of the
|
||||
violation by some reasonable means, this is the first time you have
|
||||
received notice of violation of this License (for any work) from that
|
||||
copyright holder, and you cure the violation prior to 30 days after
|
||||
your receipt of the notice.
|
||||
|
||||
Termination of your rights under this section does not terminate the
|
||||
licenses of parties who have received copies or rights from you under
|
||||
this License. If your rights have been terminated and not permanently
|
||||
reinstated, you do not qualify to receive new licenses for the same
|
||||
material under section 10.
|
||||
|
||||
9. Acceptance Not Required for Having Copies.
|
||||
|
||||
You are not required to accept this License in order to receive or
|
||||
run a copy of the Program. Ancillary propagation of a covered work
|
||||
occurring solely as a consequence of using peer-to-peer transmission
|
||||
to receive a copy likewise does not require acceptance. However,
|
||||
nothing other than this License grants you permission to propagate or
|
||||
modify any covered work. These actions infringe copyright if you do
|
||||
not accept this License. Therefore, by modifying or propagating a
|
||||
covered work, you indicate your acceptance of this License to do so.
|
||||
|
||||
10. Automatic Licensing of Downstream Recipients.
|
||||
|
||||
Each time you convey a covered work, the recipient automatically
|
||||
receives a license from the original licensors, to run, modify and
|
||||
propagate that work, subject to this License. You are not responsible
|
||||
for enforcing compliance by third parties with this License.
|
||||
|
||||
An "entity transaction" is a transaction transferring control of an
|
||||
organization, or substantially all assets of one, or subdividing an
|
||||
organization, or merging organizations. If propagation of a covered
|
||||
work results from an entity transaction, each party to that
|
||||
transaction who receives a copy of the work also receives whatever
|
||||
licenses to the work the party's predecessor in interest had or could
|
||||
give under the previous paragraph, plus a right to possession of the
|
||||
Corresponding Source of the work from the predecessor in interest, if
|
||||
the predecessor has it or can get it with reasonable efforts.
|
||||
|
||||
You may not impose any further restrictions on the exercise of the
|
||||
rights granted or affirmed under this License. For example, you may
|
||||
not impose a license fee, royalty, or other charge for exercise of
|
||||
rights granted under this License, and you may not initiate litigation
|
||||
(including a cross-claim or counterclaim in a lawsuit) alleging that
|
||||
any patent claim is infringed by making, using, selling, offering for
|
||||
sale, or importing the Program or any portion of it.
|
||||
|
||||
11. Patents.
|
||||
|
||||
A "contributor" is a copyright holder who authorizes use under this
|
||||
License of the Program or a work on which the Program is based. The
|
||||
work thus licensed is called the contributor's "contributor version".
|
||||
|
||||
A contributor's "essential patent claims" are all patent claims
|
||||
owned or controlled by the contributor, whether already acquired or
|
||||
hereafter acquired, that would be infringed by some manner, permitted
|
||||
by this License, of making, using, or selling its contributor version,
|
||||
but do not include claims that would be infringed only as a
|
||||
consequence of further modification of the contributor version. For
|
||||
purposes of this definition, "control" includes the right to grant
|
||||
patent sublicenses in a manner consistent with the requirements of
|
||||
this License.
|
||||
|
||||
Each contributor grants you a non-exclusive, worldwide, royalty-free
|
||||
patent license under the contributor's essential patent claims, to
|
||||
make, use, sell, offer for sale, import and otherwise run, modify and
|
||||
propagate the contents of its contributor version.
|
||||
|
||||
In the following three paragraphs, a "patent license" is any express
|
||||
agreement or commitment, however denominated, not to enforce a patent
|
||||
(such as an express permission to practice a patent or covenant not to
|
||||
sue for patent infringement). To "grant" such a patent license to a
|
||||
party means to make such an agreement or commitment not to enforce a
|
||||
patent against the party.
|
||||
|
||||
If you convey a covered work, knowingly relying on a patent license,
|
||||
and the Corresponding Source of the work is not available for anyone
|
||||
to copy, free of charge and under the terms of this License, through a
|
||||
publicly available network server or other readily accessible means,
|
||||
then you must either (1) cause the Corresponding Source to be so
|
||||
available, or (2) arrange to deprive yourself of the benefit of the
|
||||
patent license for this particular work, or (3) arrange, in a manner
|
||||
consistent with the requirements of this License, to extend the patent
|
||||
license to downstream recipients. "Knowingly relying" means you have
|
||||
actual knowledge that, but for the patent license, your conveying the
|
||||
covered work in a country, or your recipient's use of the covered work
|
||||
in a country, would infringe one or more identifiable patents in that
|
||||
country that you have reason to believe are valid.
|
||||
|
||||
If, pursuant to or in connection with a single transaction or
|
||||
arrangement, you convey, or propagate by procuring conveyance of, a
|
||||
covered work, and grant a patent license to some of the parties
|
||||
receiving the covered work authorizing them to use, propagate, modify
|
||||
or convey a specific copy of the covered work, then the patent license
|
||||
you grant is automatically extended to all recipients of the covered
|
||||
work and works based on it.
|
||||
|
||||
A patent license is "discriminatory" if it does not include within
|
||||
the scope of its coverage, prohibits the exercise of, or is
|
||||
conditioned on the non-exercise of one or more of the rights that are
|
||||
specifically granted under this License. You may not convey a covered
|
||||
work if you are a party to an arrangement with a third party that is
|
||||
in the business of distributing software, under which you make payment
|
||||
to the third party based on the extent of your activity of conveying
|
||||
the work, and under which the third party grants, to any of the
|
||||
parties who would receive the covered work from you, a discriminatory
|
||||
patent license (a) in connection with copies of the covered work
|
||||
conveyed by you (or copies made from those copies), or (b) primarily
|
||||
for and in connection with specific products or compilations that
|
||||
contain the covered work, unless you entered into that arrangement,
|
||||
or that patent license was granted, prior to 28 March 2007.
|
||||
|
||||
Nothing in this License shall be construed as excluding or limiting
|
||||
any implied license or other defenses to infringement that may
|
||||
otherwise be available to you under applicable patent law.
|
||||
|
||||
12. No Surrender of Others' Freedom.
|
||||
|
||||
If conditions are imposed on you (whether by court order, agreement or
|
||||
otherwise) that contradict the conditions of this License, they do not
|
||||
excuse you from the conditions of this License. If you cannot convey a
|
||||
covered work so as to satisfy simultaneously your obligations under this
|
||||
License and any other pertinent obligations, then as a consequence you may
|
||||
not convey it at all. For example, if you agree to terms that obligate you
|
||||
to collect a royalty for further conveying from those to whom you convey
|
||||
the Program, the only way you could satisfy both those terms and this
|
||||
License would be to refrain entirely from conveying the Program.
|
||||
|
||||
13. Use with the GNU Affero General Public License.
|
||||
|
||||
Notwithstanding any other provision of this License, you have
|
||||
permission to link or combine any covered work with a work licensed
|
||||
under version 3 of the GNU Affero General Public License into a single
|
||||
combined work, and to convey the resulting work. The terms of this
|
||||
License will continue to apply to the part which is the covered work,
|
||||
but the special requirements of the GNU Affero General Public License,
|
||||
section 13, concerning interaction through a network will apply to the
|
||||
combination as such.
|
||||
|
||||
14. Revised Versions of this License.
|
||||
|
||||
The Free Software Foundation may publish revised and/or new versions of
|
||||
the GNU General Public License from time to time. Such new versions will
|
||||
be similar in spirit to the present version, but may differ in detail to
|
||||
address new problems or concerns.
|
||||
|
||||
Each version is given a distinguishing version number. If the
|
||||
Program specifies that a certain numbered version of the GNU General
|
||||
Public License "or any later version" applies to it, you have the
|
||||
option of following the terms and conditions either of that numbered
|
||||
version or of any later version published by the Free Software
|
||||
Foundation. If the Program does not specify a version number of the
|
||||
GNU General Public License, you may choose any version ever published
|
||||
by the Free Software Foundation.
|
||||
|
||||
If the Program specifies that a proxy can decide which future
|
||||
versions of the GNU General Public License can be used, that proxy's
|
||||
public statement of acceptance of a version permanently authorizes you
|
||||
to choose that version for the Program.
|
||||
|
||||
Later license versions may give you additional or different
|
||||
permissions. However, no additional obligations are imposed on any
|
||||
author or copyright holder as a result of your choosing to follow a
|
||||
later version.
|
||||
|
||||
15. Disclaimer of Warranty.
|
||||
|
||||
THERE IS NO WARRANTY FOR THE PROGRAM, TO THE EXTENT PERMITTED BY
|
||||
APPLICABLE LAW. EXCEPT WHEN OTHERWISE STATED IN WRITING THE COPYRIGHT
|
||||
HOLDERS AND/OR OTHER PARTIES PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY
|
||||
OF ANY KIND, EITHER EXPRESSED OR IMPLIED, INCLUDING, BUT NOT LIMITED TO,
|
||||
THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
||||
PURPOSE. THE ENTIRE RISK AS TO THE QUALITY AND PERFORMANCE OF THE PROGRAM
|
||||
IS WITH YOU. SHOULD THE PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF
|
||||
ALL NECESSARY SERVICING, REPAIR OR CORRECTION.
|
||||
|
||||
16. Limitation of Liability.
|
||||
|
||||
IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING
|
||||
WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MODIFIES AND/OR CONVEYS
|
||||
THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES, INCLUDING ANY
|
||||
GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING OUT OF THE
|
||||
USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED TO LOSS OF
|
||||
DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY YOU OR THIRD
|
||||
PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER PROGRAMS),
|
||||
EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE POSSIBILITY OF
|
||||
SUCH DAMAGES.
|
||||
|
||||
17. Interpretation of Sections 15 and 16.
|
||||
|
||||
If the disclaimer of warranty and limitation of liability provided
|
||||
above cannot be given local legal effect according to their terms,
|
||||
reviewing courts shall apply local law that most closely approximates
|
||||
an absolute waiver of all civil liability in connection with the
|
||||
Program, unless a warranty or assumption of liability accompanies a
|
||||
copy of the Program in return for a fee.
|
||||
|
||||
END OF TERMS AND CONDITIONS
|
||||
|
||||
How to Apply These Terms to Your New Programs
|
||||
|
||||
If you develop a new program, and you want it to be of the greatest
|
||||
possible use to the public, the best way to achieve this is to make it
|
||||
free software which everyone can redistribute and change under these terms.
|
||||
|
||||
To do so, attach the following notices to the program. It is safest
|
||||
to attach them to the start of each source file to most effectively
|
||||
state the exclusion of warranty; and each file should have at least
|
||||
the "copyright" line and a pointer to where the full notice is found.
|
||||
|
||||
<one line to give the program's name and a brief idea of what it does.>
|
||||
Copyright (C) <year> <name of author>
|
||||
|
||||
This program is free software: you can redistribute it and/or modify
|
||||
it under the terms of the GNU General Public License as published by
|
||||
the Free Software Foundation, either version 3 of the License, or
|
||||
(at your option) any later version.
|
||||
|
||||
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. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
|
||||
Also add information on how to contact you by electronic and paper mail.
|
||||
|
||||
If the program does terminal interaction, make it output a short
|
||||
notice like this when it starts in an interactive mode:
|
||||
|
||||
<program> Copyright (C) <year> <name of author>
|
||||
This program comes with ABSOLUTELY NO WARRANTY; for details type `show w'.
|
||||
This is free software, and you are welcome to redistribute it
|
||||
under certain conditions; type `show c' for details.
|
||||
|
||||
The hypothetical commands `show w' and `show c' should show the appropriate
|
||||
parts of the General Public License. Of course, your program's commands
|
||||
might be different; for a GUI interface, you would use an "about box".
|
||||
|
||||
You should also get your employer (if you work as a programmer) or school,
|
||||
if any, to sign a "copyright disclaimer" for the program, if necessary.
|
||||
For more information on this, and how to apply and follow the GNU GPL, see
|
||||
<http://www.gnu.org/licenses/>.
|
||||
|
||||
The GNU General Public License does not permit incorporating your program
|
||||
into proprietary programs. If your program is a subroutine library, you
|
||||
may consider it more useful to permit linking proprietary applications with
|
||||
the library. If this is what you want to do, use the GNU Lesser General
|
||||
Public License instead of this License. But first, please read
|
||||
<http://www.gnu.org/philosophy/why-not-lgpl.html>.
|
|
@ -0,0 +1,5 @@
|
|||
AUTOMAKE_OPTIONS = foreign dist-bzip2 1.6
|
||||
ACLOCAL_AMFLAGS = -I m4
|
||||
|
||||
SUBDIRS = src
|
||||
|
|
@ -0,0 +1,95 @@
|
|||
AC_INIT([uk0-souncard],
|
||||
m4_esyscmd([./git-version-gen .tarball-version]),
|
||||
[jolly@eversberg.eu])
|
||||
|
||||
dnl *This* is the root dir, even if an install-sh exists in ../ or ../../
|
||||
AC_CONFIG_AUX_DIR([.])
|
||||
|
||||
AM_INIT_AUTOMAKE([subdir-objects dist-bzip2])
|
||||
AC_CONFIG_TESTDIR(tests)
|
||||
|
||||
dnl kernel style compile messages
|
||||
m4_ifdef([AM_SILENT_RULES], [AM_SILENT_RULES([yes])])
|
||||
|
||||
dnl include release helper
|
||||
RELMAKE='-include osmo-release.mk'
|
||||
AC_SUBST([RELMAKE])
|
||||
|
||||
dnl checks for programs
|
||||
AC_PROG_MAKE_SET
|
||||
AC_PROG_CC
|
||||
AC_PROG_INSTALL
|
||||
AC_PROG_RANLIB
|
||||
|
||||
AC_CONFIG_MACRO_DIR([m4])
|
||||
|
||||
AC_ARG_ENABLE(sanitize,
|
||||
[AS_HELP_STRING(
|
||||
[--enable-sanitize],
|
||||
[Compile with address sanitizer enabled],
|
||||
)],
|
||||
[sanitize=$enableval], [sanitize="no"])
|
||||
if test x"$sanitize" = x"yes"
|
||||
then
|
||||
CFLAGS="$CFLAGS -fsanitize=address -fsanitize=undefined"
|
||||
CPPFLAGS="$CPPFLAGS -fsanitize=address -fsanitize=undefined"
|
||||
fi
|
||||
|
||||
AC_ARG_ENABLE(werror,
|
||||
[AS_HELP_STRING(
|
||||
[--enable-werror],
|
||||
[Turn all compiler warnings into errors, with exceptions:
|
||||
a) deprecation (allow upstream to mark deprecation without breaking builds);
|
||||
b) "#warning" pragmas (allow to remind ourselves of errors without breaking builds)
|
||||
]
|
||||
)],
|
||||
[werror=$enableval], [werror="no"])
|
||||
if test x"$werror" = x"yes"
|
||||
then
|
||||
WERROR_FLAGS="-Werror"
|
||||
WERROR_FLAGS+=" -Wno-error=deprecated -Wno-error=deprecated-declarations"
|
||||
WERROR_FLAGS+=" -Wno-error=cpp" # "#warning"
|
||||
CFLAGS="$CFLAGS $WERROR_FLAGS"
|
||||
CPPFLAGS="$CPPFLAGS $WERROR_FLAGS"
|
||||
fi
|
||||
|
||||
CFLAGS="$CFLAGS -Wall"
|
||||
CPPFLAGS="$CPPFLAGS -Wall"
|
||||
|
||||
dnl checks for header files
|
||||
AC_HEADER_STDC
|
||||
AC_CHECK_HEADERS(execinfo.h sys/select.h sys/socket.h syslog.h ctype.h)
|
||||
|
||||
# The following test is taken from WebKit's webkit.m4
|
||||
saved_CFLAGS="$CFLAGS"
|
||||
CFLAGS="$CFLAGS -fvisibility=hidden "
|
||||
AC_MSG_CHECKING([if ${CC} supports -fvisibility=hidden])
|
||||
AC_COMPILE_IFELSE([AC_LANG_SOURCE([char foo;])],
|
||||
[ AC_MSG_RESULT([yes])
|
||||
SYMBOL_VISIBILITY="-fvisibility=hidden"],
|
||||
AC_MSG_RESULT([no]))
|
||||
CFLAGS="$saved_CFLAGS"
|
||||
AC_SUBST(SYMBOL_VISIBILITY)
|
||||
|
||||
dnl Generate the output
|
||||
AM_CONFIG_HEADER(config.h)
|
||||
|
||||
AC_CHECK_LIB([m], [main])
|
||||
|
||||
AC_ARG_WITH([alsa], [AS_HELP_STRING([--with-alsa], [compile with Alsa driver @<:@default=check@:>@]) ], [], [with_alsa="check"])
|
||||
AS_IF([test "x$with_alsa" != xno], [PKG_CHECK_MODULES(ALSA, alsa >= 1.0, with_alsa=yes, with_alsa=no)])
|
||||
AM_CONDITIONAL(HAVE_ALSA, test "x$with_alsa" == "xyes" )
|
||||
AS_IF([test "x$with_alsa" == "xyes"],[AC_MSG_NOTICE( Compiling with Alsa support )], [AC_MSG_NOTICE( Alsa sound card not supported. Consider adjusting the PKG_CONFIG_PATH environment variable if you installed software in a non-standard prefix. )])
|
||||
AM_CONDITIONAL(HAVE_SDR, false )
|
||||
|
||||
AC_OUTPUT(
|
||||
src/lib/liboptions/Makefile
|
||||
src/lib/libdebug/Makefile
|
||||
src/lib/libsample/Makefile
|
||||
src/lib/libfilter/Makefile
|
||||
src/lib/libwave/Makefile
|
||||
src/lib/libdisplay/Makefile
|
||||
src/lib/libsound/Makefile
|
||||
src/uk0/Makefile
|
||||
src/Makefile
|
||||
Makefile)
|
|
@ -0,0 +1,151 @@
|
|||
#!/bin/sh
|
||||
# Print a version string.
|
||||
scriptversion=2010-01-28.01
|
||||
|
||||
# Copyright (C) 2007-2010 Free Software Foundation, Inc.
|
||||
#
|
||||
# This program is free software: you can redistribute it and/or modify
|
||||
# it under the terms of the GNU General Public License as published by
|
||||
# the Free Software Foundation; either version 3 of the License, or
|
||||
# (at your option) any later version.
|
||||
#
|
||||
# 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. See the
|
||||
# GNU General Public License for more details.
|
||||
#
|
||||
# You should have received a copy of the GNU General Public License
|
||||
# along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
|
||||
# This script is derived from GIT-VERSION-GEN from GIT: http://git.or.cz/.
|
||||
# It may be run two ways:
|
||||
# - from a git repository in which the "git describe" command below
|
||||
# produces useful output (thus requiring at least one signed tag)
|
||||
# - from a non-git-repo directory containing a .tarball-version file, which
|
||||
# presumes this script is invoked like "./git-version-gen .tarball-version".
|
||||
|
||||
# In order to use intra-version strings in your project, you will need two
|
||||
# separate generated version string files:
|
||||
#
|
||||
# .tarball-version - present only in a distribution tarball, and not in
|
||||
# a checked-out repository. Created with contents that were learned at
|
||||
# the last time autoconf was run, and used by git-version-gen. Must not
|
||||
# be present in either $(srcdir) or $(builddir) for git-version-gen to
|
||||
# give accurate answers during normal development with a checked out tree,
|
||||
# but must be present in a tarball when there is no version control system.
|
||||
# Therefore, it cannot be used in any dependencies. GNUmakefile has
|
||||
# hooks to force a reconfigure at distribution time to get the value
|
||||
# correct, without penalizing normal development with extra reconfigures.
|
||||
#
|
||||
# .version - present in a checked-out repository and in a distribution
|
||||
# tarball. Usable in dependencies, particularly for files that don't
|
||||
# want to depend on config.h but do want to track version changes.
|
||||
# Delete this file prior to any autoconf run where you want to rebuild
|
||||
# files to pick up a version string change; and leave it stale to
|
||||
# minimize rebuild time after unrelated changes to configure sources.
|
||||
#
|
||||
# It is probably wise to add these two files to .gitignore, so that you
|
||||
# don't accidentally commit either generated file.
|
||||
#
|
||||
# Use the following line in your configure.ac, so that $(VERSION) will
|
||||
# automatically be up-to-date each time configure is run (and note that
|
||||
# since configure.ac no longer includes a version string, Makefile rules
|
||||
# should not depend on configure.ac for version updates).
|
||||
#
|
||||
# AC_INIT([GNU project],
|
||||
# m4_esyscmd([build-aux/git-version-gen .tarball-version]),
|
||||
# [bug-project@example])
|
||||
#
|
||||
# Then use the following lines in your Makefile.am, so that .version
|
||||
# will be present for dependencies, and so that .tarball-version will
|
||||
# exist in distribution tarballs.
|
||||
#
|
||||
# BUILT_SOURCES = $(top_srcdir)/.version
|
||||
# $(top_srcdir)/.version:
|
||||
# echo $(VERSION) > $@-t && mv $@-t $@
|
||||
# dist-hook:
|
||||
# echo $(VERSION) > $(distdir)/.tarball-version
|
||||
|
||||
case $# in
|
||||
1) ;;
|
||||
*) echo 1>&2 "Usage: $0 \$srcdir/.tarball-version"; exit 1;;
|
||||
esac
|
||||
|
||||
tarball_version_file=$1
|
||||
nl='
|
||||
'
|
||||
|
||||
# First see if there is a tarball-only version file.
|
||||
# then try "git describe", then default.
|
||||
if test -f $tarball_version_file
|
||||
then
|
||||
v=`cat $tarball_version_file` || exit 1
|
||||
case $v in
|
||||
*$nl*) v= ;; # reject multi-line output
|
||||
[0-9]*) ;;
|
||||
*) v= ;;
|
||||
esac
|
||||
test -z "$v" \
|
||||
&& echo "$0: WARNING: $tarball_version_file seems to be damaged" 1>&2
|
||||
fi
|
||||
|
||||
if test -n "$v"
|
||||
then
|
||||
: # use $v
|
||||
elif
|
||||
v=`git describe --abbrev=4 --match='v*' HEAD 2>/dev/null \
|
||||
|| git describe --abbrev=4 HEAD 2>/dev/null` \
|
||||
&& case $v in
|
||||
[0-9]*) ;;
|
||||
v[0-9]*) ;;
|
||||
*) (exit 1) ;;
|
||||
esac
|
||||
then
|
||||
# Is this a new git that lists number of commits since the last
|
||||
# tag or the previous older version that did not?
|
||||
# Newer: v6.10-77-g0f8faeb
|
||||
# Older: v6.10-g0f8faeb
|
||||
case $v in
|
||||
*-*-*) : git describe is okay three part flavor ;;
|
||||
*-*)
|
||||
: git describe is older two part flavor
|
||||
# Recreate the number of commits and rewrite such that the
|
||||
# result is the same as if we were using the newer version
|
||||
# of git describe.
|
||||
vtag=`echo "$v" | sed 's/-.*//'`
|
||||
numcommits=`git rev-list "$vtag"..HEAD | wc -l`
|
||||
v=`echo "$v" | sed "s/\(.*\)-\(.*\)/\1-$numcommits-\2/"`;
|
||||
;;
|
||||
esac
|
||||
|
||||
# Change the first '-' to a '.', so version-comparing tools work properly.
|
||||
# Remove the "g" in git describe's output string, to save a byte.
|
||||
v=`echo "$v" | sed 's/-/./;s/\(.*\)-g/\1-/'`;
|
||||
else
|
||||
v=UNKNOWN
|
||||
fi
|
||||
|
||||
v=`echo "$v" |sed 's/^v//'`
|
||||
|
||||
# Don't declare a version "dirty" merely because a time stamp has changed.
|
||||
git status > /dev/null 2>&1
|
||||
|
||||
dirty=`sh -c 'git diff-index --name-only HEAD' 2>/dev/null` || dirty=
|
||||
case "$dirty" in
|
||||
'') ;;
|
||||
*) # Append the suffix only if there isn't one already.
|
||||
case $v in
|
||||
*-dirty) ;;
|
||||
*) v="$v-dirty" ;;
|
||||
esac ;;
|
||||
esac
|
||||
|
||||
# Omit the trailing newline, so that m4_esyscmd can use the result directly.
|
||||
echo "$v" | tr -d '\012'
|
||||
|
||||
# Local variables:
|
||||
# eval: (add-hook 'write-file-hooks 'time-stamp)
|
||||
# time-stamp-start: "scriptversion="
|
||||
# time-stamp-format: "%:y-%02m-%02d.%02H"
|
||||
# time-stamp-end: "$"
|
||||
# End:
|
|
@ -0,0 +1,18 @@
|
|||
AUTOMAKE_OPTIONS = foreign
|
||||
|
||||
SUBDIRS = \
|
||||
lib/liboptions \
|
||||
lib/libdebug \
|
||||
lib/libsample \
|
||||
lib/libfilter \
|
||||
lib/libwave \
|
||||
lib/libdisplay
|
||||
|
||||
if HAVE_ALSA
|
||||
SUBDIRS += \
|
||||
lib/libsound
|
||||
endif
|
||||
|
||||
SUBDIRS += \
|
||||
uk0
|
||||
|
|
@ -0,0 +1 @@
|
|||
Subproject commit decafb93fbac198185ad7c98ffe860fd0959bec1
|
|
@ -1,7 +0,0 @@
|
|||
AM_CPPFLAGS = -Wall -Wextra -g $(all_includes)
|
||||
|
||||
noinst_LIBRARIES = libdebug.a
|
||||
|
||||
libdebug_a_SOURCES = \
|
||||
debug.c
|
||||
|
|
@ -1,327 +0,0 @@
|
|||
/* Simple debug functions for level and category filtering
|
||||
*
|
||||
* (C) 2016 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdarg.h>
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include <stdlib.h>
|
||||
#include <stdint.h>
|
||||
#include <errno.h>
|
||||
#include <math.h>
|
||||
#include <time.h>
|
||||
#include <pthread.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <sys/time.h>
|
||||
#include "debug.h"
|
||||
|
||||
const char *debug_level[] = {
|
||||
"debug ",
|
||||
"info ",
|
||||
"notice ",
|
||||
"error ",
|
||||
NULL,
|
||||
};
|
||||
|
||||
struct debug_cat {
|
||||
const char *name;
|
||||
const char *color;
|
||||
} debug_cat[] = {
|
||||
{ "options", "\033[0;33m" },
|
||||
{ "sender", "\033[1;33m" },
|
||||
{ "sound", "\033[0;35m" },
|
||||
{ "dsp", "\033[0;31m" },
|
||||
{ "anetz", "\033[1;34m" },
|
||||
{ "bnetz", "\033[1;34m" },
|
||||
{ "cnetz", "\033[1;34m" },
|
||||
{ "nmt", "\033[1;34m" },
|
||||
{ "amps", "\033[1;34m" },
|
||||
{ "r2000", "\033[1;34m" },
|
||||
{ "imts", "\033[1;34m" },
|
||||
{ "mpt1327", "\033[1;34m" },
|
||||
{ "jollycom", "\033[1;34m" },
|
||||
{ "eurosignal", "\033[1;34m" },
|
||||
{ "pocsag", "\033[1;34m" },
|
||||
{ "5-ton-folge", "\033[1;34m" },
|
||||
{ "frame", "\033[0;36m" },
|
||||
{ "call", "\033[0;37m" },
|
||||
{ "cc", "\033[1;32m" },
|
||||
{ "database", "\033[0;33m" },
|
||||
{ "transaction", "\033[0;32m" },
|
||||
{ "dms", "\033[0;33m" },
|
||||
{ "sms", "\033[1;37m" },
|
||||
{ "sdr", "\033[1;31m" },
|
||||
{ "uhd", "\033[1;35m" },
|
||||
{ "soapy", "\033[1;35m" },
|
||||
{ "wave", "\033[1;33m" },
|
||||
{ "radio", "\033[1;34m" },
|
||||
{ "am791x", "\033[0;31m" },
|
||||
{ "uart", "\033[0;32m" },
|
||||
{ "device", "\033[0;33m" },
|
||||
{ "datenklo", "\033[1;34m" },
|
||||
{ "zeit", "\033[1;34m" },
|
||||
{ "sim layer 1", "\033[0;31m" },
|
||||
{ "sim layer 2", "\033[0;33m" },
|
||||
{ "sim ICL layer", "\033[0;36m" },
|
||||
{ "sim layer 7", "\033[0;37m" },
|
||||
{ "mtp layer 2", "\033[1;33m" },
|
||||
{ "mtp layer 3", "\033[1;36m" },
|
||||
{ "MuP", "\033[1;37m" },
|
||||
{ "router", "\033[1;35m" },
|
||||
{ "stderr", "\033[1;37m" },
|
||||
{ "ss5", "\033[1;34m" },
|
||||
{ "isdn", "\033[1;35m" },
|
||||
{ "misdn", "\033[0;34m" },
|
||||
{ "dss1", "\033[1;34m" },
|
||||
{ "sip", "\033[1;35m" },
|
||||
{ "telephone", "\033[1;34m" },
|
||||
{ "UK0", "\033[0;31m" },
|
||||
{ "ph", "\033[0;33m" },
|
||||
{ NULL, NULL }
|
||||
};
|
||||
|
||||
int debuglevel = DEBUG_INFO;
|
||||
int debug_date = 0;
|
||||
uint64_t debug_mask = ~0;
|
||||
extern int num_kanal;
|
||||
|
||||
void (*clear_console_text)(void) = NULL;
|
||||
void (*print_console_text)(void) = NULL;
|
||||
|
||||
int debug_limit_scroll = 0;
|
||||
|
||||
static int lock_initialized = 0;
|
||||
static pthread_mutex_t debug_mutex;
|
||||
|
||||
void lock_debug(void)
|
||||
{
|
||||
int rc;
|
||||
|
||||
if (!lock_initialized) {
|
||||
rc = pthread_mutex_init(&debug_mutex, NULL);
|
||||
if (rc == 0)
|
||||
lock_initialized = 1;
|
||||
}
|
||||
if (lock_initialized)
|
||||
pthread_mutex_lock(&debug_mutex);
|
||||
}
|
||||
|
||||
void unlock_debug(void)
|
||||
{
|
||||
if (lock_initialized)
|
||||
pthread_mutex_unlock(&debug_mutex);
|
||||
}
|
||||
|
||||
void get_win_size(int *w, int *h)
|
||||
{
|
||||
struct winsize win;
|
||||
int rc;
|
||||
|
||||
rc = ioctl(0, TIOCGWINSZ, &win);
|
||||
if (rc) {
|
||||
*w = 80;
|
||||
*h = 25;
|
||||
return;
|
||||
}
|
||||
|
||||
*h = win.ws_row;
|
||||
*w = win.ws_col;
|
||||
}
|
||||
|
||||
void _printdebug(const char *file, const char __attribute__((unused)) *function, int line, int cat, int level, const char *kanal, const char *fmt, ...)
|
||||
{
|
||||
char buffer[4096], *b = buffer;
|
||||
int s = sizeof(buffer) - 1;
|
||||
const char *p;
|
||||
va_list args;
|
||||
int w, h;
|
||||
|
||||
if (debuglevel > level)
|
||||
return;
|
||||
|
||||
if (!(debug_mask & ((uint64_t)1 << cat)))
|
||||
return;
|
||||
|
||||
lock_debug();
|
||||
|
||||
buffer[sizeof(buffer) - 1] = '\0';
|
||||
|
||||
/* if kanal is used, prefix the channel number */
|
||||
if (num_kanal > 1 && kanal) {
|
||||
sprintf(buffer, "(chan %s) ", kanal);
|
||||
b = strchr(buffer, '\0');
|
||||
s -= strlen(buffer);
|
||||
}
|
||||
|
||||
va_start(args, fmt);
|
||||
vsnprintf(b, s, fmt, args);
|
||||
va_end(args);
|
||||
|
||||
while ((p = strchr(file, '/')))
|
||||
file = p + 1;
|
||||
if (clear_console_text)
|
||||
clear_console_text();
|
||||
if (debug_limit_scroll) {
|
||||
get_win_size(&w, &h);
|
||||
printf("\0337\033[%d;%dr\0338", debug_limit_scroll + 1, h);
|
||||
}
|
||||
if (debug_date) {
|
||||
struct timeval tv;
|
||||
struct tm *tm;
|
||||
|
||||
gettimeofday(&tv, NULL);
|
||||
tm = localtime(&tv.tv_sec);
|
||||
|
||||
printf("%04d-%02d-%02d %02d:%02d:%02d.%03d ", tm->tm_year + 1900, tm->tm_mon + 1, tm->tm_mday, tm->tm_hour, tm->tm_min, tm->tm_sec, (int)(tv.tv_usec / 10000.0));
|
||||
}
|
||||
printf("%s%s:%4d %s: %s\033[0;39m", debug_cat[cat].color, file, line, debug_level[level], buffer);
|
||||
if (debug_limit_scroll)
|
||||
printf("\0337\033[%d;%dr\0338", 1, h);
|
||||
if (print_console_text)
|
||||
print_console_text();
|
||||
fflush(stdout);
|
||||
|
||||
unlock_debug();
|
||||
}
|
||||
|
||||
const char *debug_amplitude(double level)
|
||||
{
|
||||
static char text[42];
|
||||
|
||||
strcpy(text, " : ");
|
||||
if (level > 1.0)
|
||||
level = 1.0;
|
||||
if (level < -1.0)
|
||||
level = -1.0;
|
||||
text[20 + (int)(level * 20)] = '*';
|
||||
|
||||
return text;
|
||||
}
|
||||
|
||||
#define level2db(level) (20 * log10(level))
|
||||
|
||||
const char *debug_db(double level_db)
|
||||
{
|
||||
static char text[128];
|
||||
int l;
|
||||
|
||||
strcpy(text, ": . : . : . : . : . : . : . : . | . : . : . : . : . : . : . : . :");
|
||||
if (level_db <= 0.0)
|
||||
return text;
|
||||
l = (int)round(level2db(level_db));
|
||||
if (l > 48)
|
||||
return text;
|
||||
if (l < -48)
|
||||
return text;
|
||||
text[l + 48] = '*';
|
||||
|
||||
return text;
|
||||
}
|
||||
|
||||
void debug_print_help(void)
|
||||
{
|
||||
printf(" -v --verbose <level> | <level>,<category>[,<category>[,...]] | list\n");
|
||||
printf(" Use 'list' to get a list of all levels and categories\n");
|
||||
printf(" Verbose level: digit of debug level (default = '%d')\n", debuglevel);
|
||||
printf(" Verbose level+category: level digit followed by one or more categories\n");
|
||||
printf(" -> If no category is specified, all categories are selected\n");
|
||||
printf(" -v --verbose date\n");
|
||||
printf(" Show date with debug output\n");
|
||||
}
|
||||
|
||||
void debug_list_cat(void)
|
||||
{
|
||||
int i;
|
||||
|
||||
printf("Give number of debug level:\n");
|
||||
for (i = 0; debug_level[i]; i++)
|
||||
printf(" %d = %s\n", i, debug_level[i]);
|
||||
printf("\n");
|
||||
|
||||
printf("Give name(s) of debug category:\n");
|
||||
for (i = 0; debug_cat[i].name; i++)
|
||||
printf(" %s%s\033[0;39m\n", debug_cat[i].color, debug_cat[i].name);
|
||||
printf("\n");
|
||||
}
|
||||
|
||||
int parse_debug_opt(const char *optarg)
|
||||
{
|
||||
int i, max_level = 0;
|
||||
char *dup, *dstring, *p;
|
||||
|
||||
if (!strcasecmp(optarg, "date")) {
|
||||
debug_date = 1;
|
||||
return 0;
|
||||
}
|
||||
|
||||
for (i = 0; debug_level[i]; i++)
|
||||
max_level = i;
|
||||
|
||||
dup = dstring = strdup(optarg);
|
||||
p = strsep(&dstring, ",");
|
||||
for (i = 0; i < p[i]; i++) {
|
||||
if (p[i] < '0' || p[i] > '9') {
|
||||
fprintf(stderr, "Only digits are allowed for debug level!\n");
|
||||
free(dup);
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
debuglevel = atoi(p);
|
||||
if (debuglevel > max_level) {
|
||||
fprintf(stderr, "Debug level too high, use 'list' to show available levels!\n");
|
||||
free(dup);
|
||||
return -EINVAL;
|
||||
}
|
||||
if (dstring)
|
||||
debug_mask = 0;
|
||||
while((p = strsep(&dstring, ","))) {
|
||||
for (i = 0; debug_cat[i].name; i++) {
|
||||
if (!strcasecmp(p, debug_cat[i].name))
|
||||
break;
|
||||
}
|
||||
if (!debug_cat[i].name) {
|
||||
fprintf(stderr, "Given debug category '%s' unknown, use 'list' to show available categories!\n", p);
|
||||
free(dup);
|
||||
return -EINVAL;
|
||||
}
|
||||
debug_mask |= ((uint64_t)1 << i);
|
||||
}
|
||||
|
||||
free(dup);
|
||||
return 0;
|
||||
}
|
||||
|
||||
const char *debug_hex(const uint8_t *data, int len)
|
||||
{
|
||||
static char *text = NULL;
|
||||
char *p;
|
||||
int i;
|
||||
|
||||
if (text)
|
||||
free(text);
|
||||
p = text = calloc(1, len * 3 + 1);
|
||||
for (i = 0; i < len; i++) {
|
||||
sprintf(p, "%02x ", *data++);
|
||||
p += 3;
|
||||
}
|
||||
if (text[0])
|
||||
p[-1] = '\0';
|
||||
|
||||
return text;
|
||||
}
|
||||
|
|
@ -1,82 +0,0 @@
|
|||
|
||||
#define DEBUG_DEBUG 0 /* debug info, not for normal use */
|
||||
#define DEBUG_INFO 1 /* all info about process */
|
||||
#define DEBUG_NOTICE 2 /* something unexpected happens */
|
||||
#define DEBUG_ERROR 3 /* there is an error with this software */
|
||||
|
||||
#define DOPTIONS 0
|
||||
#define DSENDER 1
|
||||
#define DSOUND 2
|
||||
#define DDSP 3
|
||||
#define DANETZ 4
|
||||
#define DBNETZ 5
|
||||
#define DCNETZ 6
|
||||
#define DNMT 7
|
||||
#define DAMPS 8
|
||||
#define DR2000 9
|
||||
#define DIMTS 10
|
||||
#define DMPT1327 11
|
||||
#define DJOLLY 12
|
||||
#define DEURO 13
|
||||
#define DPOCSAG 14
|
||||
#define DFUENF 15
|
||||
#define DFRAME 16
|
||||
#define DCALL 17
|
||||
#define DCC 18
|
||||
#define DDB 19
|
||||
#define DTRANS 20
|
||||
#define DDMS 21
|
||||
#define DSMS 22
|
||||
#define DSDR 23
|
||||
#define DUHD 24
|
||||
#define DSOAPY 25
|
||||
#define DWAVE 26
|
||||
#define DRADIO 27
|
||||
#define DAM791X 28
|
||||
#define DUART 29
|
||||
#define DDEVICE 30
|
||||
#define DDATENKLO 31
|
||||
#define DZEIT 32
|
||||
#define DSIM1 33
|
||||
#define DSIM2 34
|
||||
#define DSIMI 35
|
||||
#define DSIM7 36
|
||||
#define DMTP2 37
|
||||
#define DMTP3 38
|
||||
#define DMUP 39
|
||||
#define DROUTER 40
|
||||
#define DSTDERR 41
|
||||
#define DSS5 42
|
||||
#define DISDN 43
|
||||
#define DMISDN 44
|
||||
#define DDSS1 45
|
||||
#define DSIP 46
|
||||
#define DTEL 47
|
||||
#define DUK0 48
|
||||
#define DPH 49
|
||||
|
||||
void lock_debug(void);
|
||||
void unlock_debug(void);
|
||||
|
||||
void get_win_size(int *w, int *h);
|
||||
|
||||
#define PDEBUG(cat, level, fmt, arg...) _printdebug(__FILE__, __FUNCTION__, __LINE__, cat, level, NULL, fmt, ## arg)
|
||||
#define PDEBUG_CHAN(cat, level, fmt, arg...) _printdebug(__FILE__, __FUNCTION__, __LINE__, cat, level, CHAN, fmt, ## arg)
|
||||
void _printdebug(const char *file, const char *function, int line, int cat, int level, const char *chan_str, const char *fmt, ...) __attribute__ ((__format__ (__printf__, 7, 8)));
|
||||
|
||||
const char *debug_amplitude(double level);
|
||||
const char *debug_db(double level_db);
|
||||
|
||||
void debug_print_help(void);
|
||||
void debug_list_cat(void);
|
||||
int parse_debug_opt(const char *opt);
|
||||
|
||||
extern int debuglevel;
|
||||
|
||||
extern void (*clear_console_text)(void);
|
||||
extern void (*print_console_text)(void);
|
||||
|
||||
extern int debug_limit_scroll;
|
||||
|
||||
const char *debug_hex(const uint8_t *data, int len);
|
||||
|
|
@ -1,19 +0,0 @@
|
|||
AM_CPPFLAGS = -Wall -Wextra -g $(all_includes)
|
||||
|
||||
noinst_LIBRARIES = libdisplay.a
|
||||
|
||||
libdisplay_a_SOURCES = \
|
||||
display_status.c \
|
||||
display_wave.c \
|
||||
display_measurements.c
|
||||
|
||||
if HAVE_SDR
|
||||
libdisplay_a_SOURCES += \
|
||||
display_iq.c \
|
||||
display_spectrum.c
|
||||
endif
|
||||
|
||||
if HAVE_SDR
|
||||
AM_CPPFLAGS += -DHAVE_SDR
|
||||
endif
|
||||
|
|
@ -1,103 +0,0 @@
|
|||
#define DISPLAY_MEAS_INTERVAL 0.1 /* time (in seconds) for each measurement values interval */
|
||||
#define DISPLAY_INTERVAL 0.04 /* time (in seconds) for each other interval */
|
||||
#define DISPLAY_PARAM_HISTORIES 10 /* number of intervals (should result in one seconds) */
|
||||
|
||||
#define MAX_DISPLAY_WIDTH 1024
|
||||
|
||||
typedef struct display_wave {
|
||||
const char *kanal;
|
||||
int interval_pos;
|
||||
int interval_max;
|
||||
int offset;
|
||||
sample_t buffer[MAX_DISPLAY_WIDTH];
|
||||
} dispwav_t;
|
||||
|
||||
enum display_measurements_type {
|
||||
DISPLAY_MEAS_LAST, /* display last value */
|
||||
DISPLAY_MEAS_PEAK, /* display peak value */
|
||||
DISPLAY_MEAS_PEAK2PEAK, /* display peak value of min..max range */
|
||||
DISPLAY_MEAS_AVG, /* display average value */
|
||||
};
|
||||
|
||||
enum display_measurements_bar {
|
||||
DISPLAY_MEAS_LEFT, /* bar graph from left */
|
||||
DISPLAY_MEAS_CENTER, /* bar graph from center */
|
||||
};
|
||||
|
||||
typedef struct display_measurements_param {
|
||||
struct display_measurements_param *next;
|
||||
char name[32]; /* parameter name (e.g. 'Deviation') */
|
||||
char format[32]; /* unit name (e.g. "%.2f KHz") */
|
||||
enum display_measurements_type type;
|
||||
enum display_measurements_bar bar;
|
||||
double min; /* minimum value */
|
||||
double max; /* maximum value */
|
||||
double mark; /* mark (target) value */
|
||||
double value; /* current value (peak, sum...) */
|
||||
double value2; /* max value for min..max range */
|
||||
double last; /* last valid value (used for DISPLAY_MEAS_LAST) */
|
||||
int value_count; /* count number of values of one interval */
|
||||
double value_history[DISPLAY_PARAM_HISTORIES]; /* history of values of last second */
|
||||
double value2_history[DISPLAY_PARAM_HISTORIES]; /* stores max for min..max range */
|
||||
int value_history_pos; /* next history value to write */
|
||||
} dispmeasparam_t;
|
||||
|
||||
typedef struct display_measurements {
|
||||
struct display_measurements *next;
|
||||
const char *kanal;
|
||||
dispmeasparam_t *param;
|
||||
} dispmeas_t;
|
||||
|
||||
#define MAX_DISPLAY_IQ 1024
|
||||
|
||||
typedef struct display_iq {
|
||||
int interval_pos;
|
||||
int interval_max;
|
||||
float buffer[MAX_DISPLAY_IQ * 2];
|
||||
} dispiq_t;
|
||||
|
||||
#define MAX_DISPLAY_SPECTRUM 1024
|
||||
|
||||
typedef struct display_spectrum_mark {
|
||||
struct display_spectrum_mark *next;
|
||||
const char *kanal;
|
||||
double frequency;
|
||||
} dispspectrum_mark_t;
|
||||
|
||||
typedef struct display_spectrum {
|
||||
int interval_pos;
|
||||
int interval_max;
|
||||
double buffer_I[MAX_DISPLAY_SPECTRUM];
|
||||
double buffer_Q[MAX_DISPLAY_SPECTRUM];
|
||||
dispspectrum_mark_t *mark;
|
||||
} dispspectrum_t;
|
||||
|
||||
#define MAX_HEIGHT_STATUS 32
|
||||
|
||||
void display_wave_init(dispwav_t *disp, int samplerate, const char *kanal);
|
||||
void display_wave_on(int on);
|
||||
void display_wave(dispwav_t *disp, sample_t *samples, int length, double range);
|
||||
|
||||
void display_status_on(int on);
|
||||
void display_status_start(void);
|
||||
void display_status_channel(const char *kanal, const char *type, const char *state);
|
||||
void display_status_subscriber(const char *number, const char *state);
|
||||
void display_status_end(void);
|
||||
|
||||
void display_measurements_init(dispmeas_t *disp, int samplerate, const char *kanal);
|
||||
void display_measurements_exit(dispmeas_t *disp);
|
||||
void display_measurements_on(int on);
|
||||
dispmeasparam_t *display_measurements_add(dispmeas_t *disp, char *name, char *format, enum display_measurements_type type, enum display_measurements_bar bar, double min, double max, double mark);
|
||||
void display_measurements_update(dispmeasparam_t *param, double value, double value2);
|
||||
void display_measurements(double elapsed);
|
||||
|
||||
void display_iq_init(int samplerate);
|
||||
void display_iq_on(int on);
|
||||
void display_iq(float *samples, int length);
|
||||
|
||||
void display_spectrum_init(int samplerate, double center_frequency);
|
||||
void display_spectrum_add_mark(const char *kanal, double frequency);
|
||||
void display_spectrum_exit(void);
|
||||
void display_spectrum_on(int on);
|
||||
void display_spectrum(float *samples, int length);
|
||||
|
|
@ -1,282 +0,0 @@
|
|||
/* display IQ data form functions
|
||||
*
|
||||
* (C) 2016 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
#include <math.h>
|
||||
#include <pthread.h>
|
||||
#include <stdlib.h>
|
||||
#include "../libsample/sample.h"
|
||||
#include "../libdebug/debug.h"
|
||||
#include "../libdisplay/display.h"
|
||||
|
||||
/* must be odd value! */
|
||||
#define SIZE 23
|
||||
|
||||
static char screen[SIZE][MAX_DISPLAY_WIDTH];
|
||||
static uint8_t screen_color[SIZE][MAX_DISPLAY_WIDTH];
|
||||
static uint8_t screen_history[SIZE * 2][MAX_DISPLAY_WIDTH];
|
||||
static int iq_on = 0;
|
||||
static double db = 80;
|
||||
|
||||
static dispiq_t disp;
|
||||
|
||||
void display_iq_init(int samplerate)
|
||||
{
|
||||
memset(&disp, 0, sizeof(disp));
|
||||
memset(&screen_history, 0, sizeof(screen_history));
|
||||
disp.interval_max = (double)samplerate * DISPLAY_INTERVAL + 0.5;
|
||||
/* should not happen due to low interval */
|
||||
if (disp.interval_max < MAX_DISPLAY_IQ - 1)
|
||||
disp.interval_max = MAX_DISPLAY_IQ - 1;
|
||||
}
|
||||
|
||||
void display_iq_on(int on)
|
||||
{
|
||||
int j;
|
||||
int w, h;
|
||||
|
||||
get_win_size(&w, &h);
|
||||
if (w > MAX_DISPLAY_WIDTH - 1)
|
||||
w = MAX_DISPLAY_WIDTH - 1;
|
||||
|
||||
if (iq_on) {
|
||||
memset(&screen, ' ', sizeof(screen));
|
||||
memset(&screen_history, 0, sizeof(screen_history));
|
||||
lock_debug();
|
||||
printf("\0337\033[H");
|
||||
for (j = 0; j < SIZE; j++) {
|
||||
screen[j][w] = '\0';
|
||||
puts(screen[j]);
|
||||
}
|
||||
printf("\0338"); fflush(stdout);
|
||||
unlock_debug();
|
||||
}
|
||||
|
||||
if (on < 0) {
|
||||
if (++iq_on == 3)
|
||||
iq_on = 0;
|
||||
} else
|
||||
iq_on = on;
|
||||
|
||||
if (iq_on)
|
||||
debug_limit_scroll = SIZE;
|
||||
else
|
||||
debug_limit_scroll = 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* plot IQ data:
|
||||
*
|
||||
* theoretical example: SIZE = 3 allows 6 steps plotted as dots
|
||||
*
|
||||
* Line 0: :
|
||||
* Line 1: :
|
||||
* Line 2: :
|
||||
*
|
||||
* The level of -1.0 .. 1.0 is scaled to -3 and 3.
|
||||
*
|
||||
* The lowest of the upper 3 dots ranges from 0.0 .. <1.5.
|
||||
* The upper most dot ranges from 2.5 .. <3.5.
|
||||
* The highest of the lower 3 dots ranges from <0.0 .. >-1.5;
|
||||
* The lower most dot ranges from -2.5 .. >-3.5.
|
||||
*
|
||||
* The center column ranges from -0.5 .. <0.5.
|
||||
* The columns about the center from -1.5 .. <1.5.
|
||||
*/
|
||||
void display_iq(float *samples, int length)
|
||||
{
|
||||
int pos, max;
|
||||
float *buffer;
|
||||
int i, j, k;
|
||||
int color = 9; /* default color */
|
||||
int x_center, y_center;
|
||||
double I, Q, L, l, s;
|
||||
int x, y;
|
||||
int v, r;
|
||||
int width, h;
|
||||
|
||||
if (!iq_on)
|
||||
return;
|
||||
|
||||
lock_debug();
|
||||
|
||||
get_win_size(&width, &h);
|
||||
if (width > MAX_DISPLAY_WIDTH - 1)
|
||||
width = MAX_DISPLAY_WIDTH - 1;
|
||||
|
||||
/* at what line we draw our zero-line and what character we use */
|
||||
x_center = width >> 1;
|
||||
y_center = (SIZE - 1) >> 1;
|
||||
|
||||
pos = disp.interval_pos;
|
||||
max = disp.interval_max;
|
||||
buffer = disp.buffer;
|
||||
|
||||
for (i = 0; i < length; i++) {
|
||||
if (pos >= MAX_DISPLAY_IQ) {
|
||||
if (++pos == max)
|
||||
pos = 0;
|
||||
continue;
|
||||
}
|
||||
buffer[pos * 2] = samples[i * 2];
|
||||
buffer[pos * 2 + 1] = samples[i * 2 + 1];
|
||||
pos++;
|
||||
if (pos == MAX_DISPLAY_IQ) {
|
||||
memset(&screen, ' ', sizeof(screen));
|
||||
memset(&screen_color, 7, sizeof(screen_color));
|
||||
/* render screen history to screen */
|
||||
for (y = 0; y < SIZE * 2; y++) {
|
||||
for (x = 0; x < width; x++) {
|
||||
v = screen_history[y][x];
|
||||
v -= 8;
|
||||
if (v < 0)
|
||||
v = 0;
|
||||
screen_history[y][x] = v;
|
||||
r = random() & 0x3f;
|
||||
if (r >= v)
|
||||
continue;
|
||||
if (screen[y/2][x] == ':')
|
||||
continue;
|
||||
if (screen[y/2][x] == '.') {
|
||||
if ((y & 1) == 0)
|
||||
screen[y/2][x] = ':';
|
||||
continue;
|
||||
}
|
||||
if (screen[y/2][x] == '\'') {
|
||||
if ((y & 1))
|
||||
screen[y/2][x] = ':';
|
||||
continue;
|
||||
}
|
||||
if ((y & 1) == 0)
|
||||
screen[y/2][x] = '\'';
|
||||
else
|
||||
screen[y/2][x] = '.';
|
||||
screen_color[y/2][x] = 4;
|
||||
}
|
||||
}
|
||||
/* plot current IQ date */
|
||||
for (j = 0; j < MAX_DISPLAY_IQ; j++) {
|
||||
I = buffer[j * 2];
|
||||
Q = buffer[j * 2 + 1];
|
||||
L = I*I + Q*Q;
|
||||
if (iq_on > 1) {
|
||||
/* logarithmic scale */
|
||||
l = sqrt(L);
|
||||
s = log10(l) * 20 + db;
|
||||
if (s < 0)
|
||||
s = 0;
|
||||
I = (I / l) * (s / db);
|
||||
Q = (Q / l) * (s / db);
|
||||
}
|
||||
x = x_center + (int)(I * (double)SIZE + (double)width + 0.5) - width;
|
||||
if (x < 0)
|
||||
continue;
|
||||
if (x > width - 1)
|
||||
continue;
|
||||
if (Q >= 0)
|
||||
y = SIZE - 1 - (int)(Q * (double)SIZE - 0.5);
|
||||
else
|
||||
y = SIZE - (int)(Q * (double)SIZE + 0.5);
|
||||
if (y < 0)
|
||||
continue;
|
||||
if (y > SIZE * 2 - 1)
|
||||
continue;
|
||||
if (screen[y/2][x] == ':' && screen_color[y/2][x] >= 10)
|
||||
goto cont;
|
||||
if (screen[y/2][x] == '.' && screen_color[y/2][x] >= 10) {
|
||||
if ((y & 1) == 0)
|
||||
screen[y/2][x] = ':';
|
||||
goto cont;
|
||||
}
|
||||
if (screen[y/2][x] == '\'' && screen_color[y/2][x] >= 10) {
|
||||
if ((y & 1))
|
||||
screen[y/2][x] = ':';
|
||||
goto cont;
|
||||
}
|
||||
if ((y & 1) == 0)
|
||||
screen[y/2][x] = '\'';
|
||||
else
|
||||
screen[y/2][x] = '.';
|
||||
cont:
|
||||
screen_history[y][x] = 255;
|
||||
/* overdrive:
|
||||
* red = close to -1..1 or above
|
||||
* yellow = close to -0.5..0.5 or above
|
||||
* Note: L is square of vector length,
|
||||
* so we compare with square values.
|
||||
*/
|
||||
if (L > 0.9 * 0.9)
|
||||
screen_color[y/2][x] = 11;
|
||||
else if (L > 0.45 * 0.45 && screen_color[y/2][x] != 11)
|
||||
screen_color[y/2][x] = 13;
|
||||
else if (screen_color[y/2][x] < 10)
|
||||
screen_color[y/2][x] = 12;
|
||||
}
|
||||
if (iq_on == 1)
|
||||
sprintf(screen[0], "(IQ linear");
|
||||
else
|
||||
sprintf(screen[0], "(IQ log %.0f dB", db);
|
||||
*strchr(screen[0], '\0') = ')';
|
||||
printf("\0337\033[H");
|
||||
for (j = 0; j < SIZE; j++) {
|
||||
for (k = 0; k < width; k++) {
|
||||
if ((j == y_center || k == x_center) && screen[j][k] == ' ') {
|
||||
/* cross */
|
||||
if (color != 4) {
|
||||
color = 4;
|
||||
printf("\033[0;34m");
|
||||
}
|
||||
if (j == y_center) {
|
||||
if (k == x_center)
|
||||
putchar('o');
|
||||
else if (k == x_center - SIZE)
|
||||
putchar('+');
|
||||
else if (k == x_center + SIZE)
|
||||
putchar('+');
|
||||
else
|
||||
putchar('-');
|
||||
} else {
|
||||
if (j == 0 || j == SIZE - 1)
|
||||
putchar('+');
|
||||
else
|
||||
putchar('|');
|
||||
}
|
||||
} else {
|
||||
if (screen_color[j][k] != color) {
|
||||
color = screen_color[j][k];
|
||||
printf("\033[%d;3%dm", color / 10, color % 10);
|
||||
}
|
||||
putchar(screen[j][k]);
|
||||
}
|
||||
}
|
||||
printf("\n");
|
||||
}
|
||||
/* reset color and position */
|
||||
printf("\033[0;39m\0338"); fflush(stdout);
|
||||
}
|
||||
}
|
||||
|
||||
disp.interval_pos = pos;
|
||||
|
||||
unlock_debug();
|
||||
}
|
||||
|
||||
|
|
@ -1,360 +0,0 @@
|
|||
/* display measurements functions
|
||||
*
|
||||
* (C) 2017 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
#include <stdlib.h>
|
||||
#include <pthread.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <math.h>
|
||||
#include "../libsample/sample.h"
|
||||
#include "../libdebug/debug.h"
|
||||
#include "../libdisplay/display.h"
|
||||
|
||||
#define MAX_NAME_LEN 16
|
||||
#define MAX_UNIT_LEN 16
|
||||
|
||||
static int has_init = 0;
|
||||
static int measurements_on = 0;
|
||||
double time_elapsed = 0.0;
|
||||
static int lines_total = 0;
|
||||
static char line[MAX_DISPLAY_WIDTH];
|
||||
static char line_color[MAX_DISPLAY_WIDTH];
|
||||
|
||||
dispmeas_t *meas_head = NULL;
|
||||
|
||||
void display_measurements_init(dispmeas_t *disp, int __attribute__((unused)) samplerate, const char *kanal)
|
||||
{
|
||||
dispmeas_t **disp_p;
|
||||
|
||||
memset(disp, 0, sizeof(*disp));
|
||||
disp->kanal = kanal;
|
||||
has_init = 1;
|
||||
lines_total = 0;
|
||||
time_elapsed = 0.0;
|
||||
|
||||
disp_p = &meas_head;
|
||||
while (*disp_p)
|
||||
disp_p = &((*disp_p)->next);
|
||||
*disp_p = disp;
|
||||
}
|
||||
|
||||
void display_measurements_exit(dispmeas_t *disp)
|
||||
{
|
||||
dispmeasparam_t *param = disp->param, *temp;
|
||||
|
||||
while (param) {
|
||||
temp = param;
|
||||
param = param->next;
|
||||
free(temp);
|
||||
}
|
||||
disp->param = NULL;
|
||||
has_init = 0;
|
||||
}
|
||||
|
||||
static int color;
|
||||
|
||||
static void display_line(int on, int w)
|
||||
{
|
||||
int j;
|
||||
|
||||
if (on) {
|
||||
for (j = 0; j < w; j++) {
|
||||
if (line_color[j] != color && line[j] != ' ') {
|
||||
color = line_color[j];
|
||||
printf("\033[%d;3%dm", color / 10, color % 10);
|
||||
}
|
||||
putchar(line[j]);
|
||||
}
|
||||
} else {
|
||||
for (j = 0; j < w; j++)
|
||||
putchar(' ');
|
||||
}
|
||||
putchar('\n');
|
||||
lines_total++;
|
||||
}
|
||||
|
||||
static void print_measurements(int on)
|
||||
{
|
||||
dispmeas_t *disp;
|
||||
dispmeasparam_t *param;
|
||||
int i, j;
|
||||
int width, h;
|
||||
char text[128];
|
||||
double value = 0.0, value2 = 0.0, hold, hold2;
|
||||
int bar_width, bar_left, bar_right, bar_hold, bar_mark;
|
||||
|
||||
get_win_size(&width, &h);
|
||||
if (width > MAX_DISPLAY_WIDTH - 1)
|
||||
width = MAX_DISPLAY_WIDTH - 1;
|
||||
|
||||
/* no display, if bar graph is less than one character */
|
||||
bar_width = width - MAX_NAME_LEN - MAX_UNIT_LEN;
|
||||
if (bar_width < 1)
|
||||
return;
|
||||
|
||||
lock_debug();
|
||||
|
||||
lines_total = 0;
|
||||
color = -1;
|
||||
printf("\0337\033[H");
|
||||
for (disp = meas_head; disp; disp = disp->next) {
|
||||
memset(line, ' ', width);
|
||||
memset(line_color, 7, width);
|
||||
sprintf(line, "(chan %s", disp->kanal);
|
||||
*strchr(line, '\0') = ')';
|
||||
display_line(on, width);
|
||||
for (param = disp->param; param; param = param->next) {
|
||||
memset(line, ' ', width);
|
||||
memset(line_color, 7, width);
|
||||
memset(line_color, 3, MAX_NAME_LEN); /* yellow */
|
||||
switch (param->type) {
|
||||
case DISPLAY_MEAS_LAST:
|
||||
value = param->value;
|
||||
param->value = -NAN;
|
||||
break;
|
||||
case DISPLAY_MEAS_PEAK:
|
||||
/* peak value */
|
||||
value = param->value;
|
||||
param->value = -NAN;
|
||||
param->value_count = 0;
|
||||
break;
|
||||
case DISPLAY_MEAS_PEAK2PEAK:
|
||||
/* peak to peak value */
|
||||
value = param->value;
|
||||
value2 = param->value2;
|
||||
param->value = -NAN;
|
||||
param->value2 = -NAN;
|
||||
param->value_count = 0;
|
||||
break;
|
||||
case DISPLAY_MEAS_AVG:
|
||||
/* average value */
|
||||
if (param->value_count)
|
||||
value = param->value / (double)param->value_count;
|
||||
else
|
||||
value = -NAN;
|
||||
param->value = 0.0;
|
||||
param->value_count = 0;
|
||||
break;
|
||||
}
|
||||
/* add current value to history */
|
||||
param->value_history[param->value_history_pos] = value;
|
||||
param->value2_history[param->value_history_pos] = value2;
|
||||
param->value_history_pos = param->value_history_pos % DISPLAY_PARAM_HISTORIES;
|
||||
/* calculate hold values */
|
||||
hold = -NAN;
|
||||
hold2 = -NAN;
|
||||
switch (param->type) {
|
||||
case DISPLAY_MEAS_LAST:
|
||||
/* if we have valid value, we update 'last' */
|
||||
if (!isnan(value)) {
|
||||
param->last = value;
|
||||
hold = value;
|
||||
} else
|
||||
hold = param->last;
|
||||
break;
|
||||
case DISPLAY_MEAS_PEAK:
|
||||
for (i = 0; i < DISPLAY_PARAM_HISTORIES; i++) {
|
||||
if (isnan(param->value_history[i]))
|
||||
continue;
|
||||
if (isnan(hold) || param->value_history[i] > hold)
|
||||
hold = param->value_history[i];
|
||||
}
|
||||
break;
|
||||
case DISPLAY_MEAS_PEAK2PEAK:
|
||||
for (i = 0; i < DISPLAY_PARAM_HISTORIES; i++) {
|
||||
if (isnan(param->value_history[i]))
|
||||
continue;
|
||||
if (isnan(hold) || param->value_history[i] < hold)
|
||||
hold = param->value_history[i];
|
||||
if (isnan(hold2) || param->value2_history[i] > hold2)
|
||||
hold2 = param->value2_history[i];
|
||||
}
|
||||
if (!isnan(hold))
|
||||
hold = hold2 - hold;
|
||||
if (!isnan(value))
|
||||
value = value2 - value;
|
||||
break;
|
||||
case DISPLAY_MEAS_AVG:
|
||||
for (i = 0, j = 0; i < DISPLAY_PARAM_HISTORIES; i++) {
|
||||
if (isnan(param->value_history[i]))
|
||||
continue;
|
||||
if (j == 0)
|
||||
hold = 0.0;
|
||||
hold += param->value_history[i];
|
||||
j++;
|
||||
}
|
||||
if (j)
|
||||
hold /= j;
|
||||
break;
|
||||
}
|
||||
/* "Deviation ::::::::::............ 4.5 KHz" */
|
||||
memcpy(line, param->name, (strlen(param->name) < MAX_NAME_LEN) ? strlen(param->name) : MAX_NAME_LEN);
|
||||
if (isinf(value) || isnan(value)) {
|
||||
bar_left = -1;
|
||||
bar_right = -1;
|
||||
} else if (param->bar == DISPLAY_MEAS_CENTER) {
|
||||
if (value >= 0.0) {
|
||||
bar_left = (-param->min) / (param->max - param->min) * ((double)bar_width - 1.0);
|
||||
bar_right = (value - param->min) / (param->max - param->min) * ((double)bar_width - 1.0);
|
||||
} else {
|
||||
bar_left = (value - param->min) / (param->max - param->min) * ((double)bar_width - 1.0);
|
||||
bar_right = (-param->min) / (param->max - param->min) * ((double)bar_width - 1.0);
|
||||
}
|
||||
} else {
|
||||
bar_left = -1;
|
||||
bar_right = (value - param->min) / (param->max - param->min) * ((double)bar_width - 1.0);
|
||||
}
|
||||
if (isinf(hold) || isnan(hold))
|
||||
bar_hold = -1;
|
||||
else
|
||||
bar_hold = (hold - param->min) / (param->max - param->min) * ((double)bar_width - 1.0);
|
||||
if (isinf(param->mark))
|
||||
bar_mark = -1;
|
||||
else
|
||||
bar_mark = (param->mark - param->min) / (param->max - param->min) * ((double)bar_width - 1.0);
|
||||
for (i = 0; i < bar_width; i++) {
|
||||
line[i + MAX_NAME_LEN] = ':';
|
||||
if (i == bar_hold)
|
||||
line_color[i + MAX_NAME_LEN] = 13;
|
||||
else if (i == bar_mark)
|
||||
line_color[i + MAX_NAME_LEN] = 14;
|
||||
else if (i >= bar_left && i <= bar_right)
|
||||
line_color[i + MAX_NAME_LEN] = 2;
|
||||
else
|
||||
line_color[i + MAX_NAME_LEN] = 4;
|
||||
}
|
||||
sprintf(text, param->format, hold);
|
||||
if (isnan(hold))
|
||||
memset(line_color + width - MAX_UNIT_LEN, 4, MAX_UNIT_LEN); /* blue */
|
||||
else
|
||||
memset(line_color + width - MAX_UNIT_LEN, 3, MAX_UNIT_LEN); /* yellow */
|
||||
strncpy(line + width - MAX_UNIT_LEN + 1, text, (strlen(text) < MAX_UNIT_LEN) ? strlen(text) : MAX_UNIT_LEN);
|
||||
display_line(on, width);
|
||||
}
|
||||
}
|
||||
/* reset color and position */
|
||||
printf("\033[0;39m\0338"); fflush(stdout);
|
||||
|
||||
debug_limit_scroll = lines_total;
|
||||
|
||||
unlock_debug();
|
||||
}
|
||||
|
||||
void display_measurements_on(int on)
|
||||
{
|
||||
if (measurements_on)
|
||||
print_measurements(0);
|
||||
|
||||
if (on < 0)
|
||||
measurements_on = 1 - measurements_on;
|
||||
else
|
||||
measurements_on = on;
|
||||
|
||||
debug_limit_scroll = 0;
|
||||
}
|
||||
|
||||
/* add new parameter on startup to the list of measurements */
|
||||
dispmeasparam_t *display_measurements_add(dispmeas_t *disp, char *name, char *format, enum display_measurements_type type, enum display_measurements_bar bar, double min, double max, double mark)
|
||||
{
|
||||
dispmeasparam_t *param, **param_p = &disp->param;
|
||||
int i;
|
||||
|
||||
if (!has_init) {
|
||||
fprintf(stderr, "Not initialized prior adding measurement, please fix!\n");
|
||||
abort();
|
||||
}
|
||||
|
||||
while (*param_p)
|
||||
param_p = &((*param_p)->next);
|
||||
*param_p = calloc(sizeof(dispmeasparam_t), 1);
|
||||
if (!*param_p)
|
||||
return NULL;
|
||||
param = *param_p;
|
||||
strncpy(param->name, name, sizeof(param->name) - 1);
|
||||
strncpy(param->format, format, sizeof(param->format) - 1);
|
||||
param->type = type;
|
||||
param->bar = bar;
|
||||
param->min = min;
|
||||
param->max = max;
|
||||
param->mark = mark;
|
||||
param->value = -NAN;
|
||||
param->value2 = -NAN;
|
||||
param->last = -NAN;
|
||||
for (i = 0; i < DISPLAY_PARAM_HISTORIES; i++)
|
||||
param->value_history[i] = -NAN;
|
||||
param->value_count = 0;
|
||||
|
||||
return param;
|
||||
}
|
||||
|
||||
void display_measurements_update(dispmeasparam_t *param, double value, double value2)
|
||||
{
|
||||
/* special case where we do not have an instance of the parameter */
|
||||
if (!param)
|
||||
return;
|
||||
|
||||
if (!has_init) {
|
||||
fprintf(stderr, "Not initialized prior updating measurement value, please fix!\n");
|
||||
abort();
|
||||
}
|
||||
|
||||
switch (param->type) {
|
||||
case DISPLAY_MEAS_LAST:
|
||||
param->value = value;
|
||||
break;
|
||||
case DISPLAY_MEAS_PEAK:
|
||||
if (isnan(param->value) || value > param->value)
|
||||
param->value = value;
|
||||
break;
|
||||
case DISPLAY_MEAS_PEAK2PEAK:
|
||||
if (param->value_count == 0 || value < param->value)
|
||||
param->value = value;
|
||||
if (param->value_count == 0 || value2 > param->value2)
|
||||
param->value2 = value2;
|
||||
param->value_count++;
|
||||
break;
|
||||
case DISPLAY_MEAS_AVG:
|
||||
param->value += value;
|
||||
param->value_count++;
|
||||
break;
|
||||
default:
|
||||
fprintf(stderr, "Parameter '%s' has unknown type %d, please fix!\n", param->name, param->type);
|
||||
abort();
|
||||
}
|
||||
}
|
||||
|
||||
void display_measurements(double elapsed)
|
||||
{
|
||||
if (!measurements_on)
|
||||
return;
|
||||
|
||||
if (!has_init)
|
||||
return;
|
||||
|
||||
/* count and check if we need to display this time */
|
||||
time_elapsed += elapsed;
|
||||
if (time_elapsed < DISPLAY_MEAS_INTERVAL)
|
||||
return;
|
||||
time_elapsed = fmod(time_elapsed, DISPLAY_MEAS_INTERVAL);
|
||||
|
||||
print_measurements(1);
|
||||
}
|
||||
|
|
@ -1,414 +0,0 @@
|
|||
/* display spectrum of IQ data
|
||||
*
|
||||
* (C) 2016 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <math.h>
|
||||
#include "../libsample/sample.h"
|
||||
#include "../libfft/fft.h"
|
||||
#include "../libdebug/debug.h"
|
||||
#include "../libdisplay/display.h"
|
||||
|
||||
#define HEIGHT 20
|
||||
|
||||
static int has_init = 0;
|
||||
static double buffer_delay[MAX_DISPLAY_SPECTRUM];
|
||||
static double buffer_hold[MAX_DISPLAY_SPECTRUM];
|
||||
static char screen[HEIGHT][MAX_DISPLAY_WIDTH];
|
||||
static uint8_t screen_color[HEIGHT][MAX_DISPLAY_WIDTH];
|
||||
static int spectrum_on = 0;
|
||||
static double db = 120;
|
||||
static double center_frequency, frequency_range;
|
||||
|
||||
static dispspectrum_t disp;
|
||||
|
||||
void display_spectrum_init(int samplerate, double _center_frequency)
|
||||
{
|
||||
memset(&disp, 0, sizeof(disp));
|
||||
disp.interval_max = (double)samplerate * DISPLAY_INTERVAL + 0.5;
|
||||
/* should not happen due to low interval */
|
||||
if (disp.interval_max < MAX_DISPLAY_SPECTRUM - 1)
|
||||
disp.interval_max = MAX_DISPLAY_SPECTRUM - 1;
|
||||
memset(buffer_delay, 0, sizeof(buffer_delay));
|
||||
|
||||
center_frequency = _center_frequency;
|
||||
frequency_range = (double)samplerate;
|
||||
|
||||
has_init = 1;
|
||||
}
|
||||
|
||||
void display_spectrum_add_mark(const char *kanal, double frequency)
|
||||
{
|
||||
dispspectrum_mark_t *mark, **mark_p;
|
||||
|
||||
if (!has_init)
|
||||
return;
|
||||
|
||||
mark = calloc(1, sizeof(*mark));
|
||||
if (!mark) {
|
||||
fprintf(stderr, "no mem!");
|
||||
abort();
|
||||
}
|
||||
mark->kanal = kanal;
|
||||
mark->frequency = frequency;
|
||||
|
||||
mark_p = &disp.mark;
|
||||
while (*mark_p)
|
||||
mark_p = &((*mark_p)->next);
|
||||
*mark_p = mark;
|
||||
}
|
||||
|
||||
void display_spectrum_exit(void)
|
||||
{
|
||||
dispspectrum_mark_t *mark = disp.mark, *temp;
|
||||
|
||||
while (mark) {
|
||||
temp = mark;
|
||||
mark = mark->next;
|
||||
free(temp);
|
||||
}
|
||||
disp.mark = NULL;
|
||||
has_init = 0;
|
||||
}
|
||||
|
||||
void display_spectrum_on(int on)
|
||||
{
|
||||
int j;
|
||||
int w, h;
|
||||
|
||||
get_win_size(&w, &h);
|
||||
if (w > MAX_DISPLAY_WIDTH - 1)
|
||||
w = MAX_DISPLAY_WIDTH - 1;
|
||||
|
||||
if (spectrum_on) {
|
||||
memset(&screen, ' ', sizeof(screen));
|
||||
memset(&buffer_hold, 0, sizeof(buffer_hold));
|
||||
lock_debug();
|
||||
printf("\0337\033[H");
|
||||
for (j = 0; j < HEIGHT; j++) {
|
||||
screen[j][w] = '\0';
|
||||
puts(screen[j]);
|
||||
}
|
||||
printf("\0338"); fflush(stdout);
|
||||
unlock_debug();
|
||||
}
|
||||
|
||||
if (on < 0) {
|
||||
if (++spectrum_on == 3)
|
||||
spectrum_on = 0;
|
||||
} else
|
||||
spectrum_on = on;
|
||||
|
||||
if (spectrum_on)
|
||||
debug_limit_scroll = HEIGHT;
|
||||
else
|
||||
debug_limit_scroll = 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* plot spectrum data:
|
||||
*
|
||||
*/
|
||||
void display_spectrum(float *samples, int length)
|
||||
{
|
||||
dispspectrum_mark_t *mark;
|
||||
char print_channel[32], print_frequency[32];
|
||||
int width, h;
|
||||
int pos, max;
|
||||
double *buffer_I, *buffer_Q;
|
||||
int color = 9; /* default color */
|
||||
int i, j, k, o;
|
||||
double I, Q, v;
|
||||
int s, e, l, n;
|
||||
|
||||
if (!spectrum_on)
|
||||
return;
|
||||
|
||||
lock_debug();
|
||||
|
||||
get_win_size(&width, &h);
|
||||
if (width > MAX_DISPLAY_WIDTH - 1)
|
||||
width = MAX_DISPLAY_WIDTH - 1;
|
||||
|
||||
/* calculate size of FFT */
|
||||
int m, fft_size = 0, fft_taps = 0;
|
||||
for (m = 0; m < 16; m++) {
|
||||
if ((1 << m) > MAX_DISPLAY_SPECTRUM)
|
||||
break;
|
||||
if ((1 << m) <= width) {
|
||||
fft_taps = m;
|
||||
fft_size = 1 << m;
|
||||
}
|
||||
}
|
||||
if (m == 16) {
|
||||
fprintf(stderr, "Size of spectrum is not a power of 2, please fix!\n");
|
||||
abort();
|
||||
}
|
||||
|
||||
int hold[fft_size], delay[fft_size], current[fft_size];
|
||||
|
||||
pos = disp.interval_pos;
|
||||
max = disp.interval_max;
|
||||
buffer_I = disp.buffer_I;
|
||||
buffer_Q = disp.buffer_Q;
|
||||
|
||||
for (i = 0; i < length; i++) {
|
||||
if (pos >= fft_size) {
|
||||
if (++pos == max)
|
||||
pos = 0;
|
||||
continue;
|
||||
}
|
||||
buffer_I[pos] = samples[i * 2];
|
||||
buffer_Q[pos] = samples[i * 2 + 1];
|
||||
pos++;
|
||||
if (pos == fft_size) {
|
||||
fft_process(1, fft_taps, buffer_I, buffer_Q);
|
||||
k = 0;
|
||||
for (j = 0; j < fft_size; j++) {
|
||||
/* scale result vertically */
|
||||
I = buffer_I[(j + fft_size / 2) % fft_size];
|
||||
Q = buffer_Q[(j + fft_size / 2) % fft_size];
|
||||
v = sqrt(I*I + Q*Q);
|
||||
v = log10(v) * 20 + db;
|
||||
if (v < 0)
|
||||
v = 0;
|
||||
v /= db;
|
||||
/* delayed */
|
||||
buffer_delay[j] -= DISPLAY_INTERVAL / 10.0;
|
||||
if (v > buffer_delay[j])
|
||||
buffer_delay[j] = v;
|
||||
delay[j] = (double)(HEIGHT * 2 - 1) * (1.0 - buffer_delay[j]);
|
||||
if (delay[j] < 0)
|
||||
delay[j] = 0;
|
||||
if (delay[j] >= (HEIGHT * 2))
|
||||
delay[j] = (HEIGHT * 2) - 1;
|
||||
/* hold */
|
||||
if (spectrum_on == 2) {
|
||||
if (v > buffer_hold[j])
|
||||
buffer_hold[j] = v;
|
||||
hold[j] = (double)(HEIGHT * 2 - 1) * (1.0 - buffer_hold[j]);
|
||||
if (hold[j] < 0)
|
||||
hold[j] = 0;
|
||||
if (hold[j] >= (HEIGHT * 2))
|
||||
hold[j] = (HEIGHT * 2) - 1;
|
||||
}
|
||||
/* current */
|
||||
current[j] = (double)(HEIGHT * 2 - 1) * (1.0 - v);
|
||||
if (current[j] < 0)
|
||||
current[j] = 0;
|
||||
if (current[j] >= (HEIGHT * 2))
|
||||
current[j] = (HEIGHT * 2) - 1;
|
||||
}
|
||||
/* plot scaled buffer */
|
||||
memset(&screen, ' ', sizeof(screen));
|
||||
memset(&screen_color, 7, sizeof(screen_color)); /* all white */
|
||||
sprintf(screen[0], "(spectrum log %.0f dB%s", db, (spectrum_on == 2) ? " HOLD" : "");
|
||||
*strchr(screen[0], '\0') = ')';
|
||||
for (j = 2; j < HEIGHT; j += 2) {
|
||||
memset(screen_color[j], 4, 7); /* blue */
|
||||
sprintf(screen[j], "%4.0f dB", -(double)(j+1) * db / (double)(HEIGHT - 1));
|
||||
screen[j][7] = ' ';
|
||||
}
|
||||
o = (width - fft_size) / 2; /* offset from left border */
|
||||
for (j = 0; j < fft_size; j++) {
|
||||
/* show current spectrum in yellow */
|
||||
s = l = n = current[j];
|
||||
/* get last and next value */
|
||||
if (j > 0)
|
||||
l = (current[j - 1] + s) / 2;
|
||||
if (j < fft_size - 1)
|
||||
n = (current[j + 1] + s) / 2;
|
||||
if (s > l && s > n) {
|
||||
/* current value is a minimum */
|
||||
e = s;
|
||||
s = (l < n) ? (l + 1) : (n + 1);
|
||||
} else if (s < l && s < n) {
|
||||
/* current value is a maximum */
|
||||
e = (l > n) ? l : n;
|
||||
} else if (l < n) {
|
||||
/* last value is higher, next value is lower */
|
||||
s = l + 1;
|
||||
e = n;
|
||||
} else if (l > n) {
|
||||
/* last value is lower, next value is higher */
|
||||
s = n + 1;
|
||||
e = l;
|
||||
} else {
|
||||
/* current, last and next values are equal */
|
||||
e = s;
|
||||
}
|
||||
if (s == e) {
|
||||
if ((s & 1) == 0)
|
||||
screen[s >> 1][j + o] = '\'';
|
||||
else
|
||||
screen[s >> 1][j + o] = '.';
|
||||
screen_color[s >> 1][j + o] = 13;
|
||||
} else {
|
||||
if ((s & 1) == 0)
|
||||
screen[s >> 1][j + o] = '|';
|
||||
else
|
||||
screen[s >> 1][j + o] = '.';
|
||||
screen_color[s >> 1][j + o] = 13;
|
||||
if ((e & 1) == 0)
|
||||
screen[e >> 1][j + o] = '\'';
|
||||
else
|
||||
screen[e >> 1][j + o] = '|';
|
||||
screen_color[e >> 1][j + o] = 13;
|
||||
for (k = (s >> 1) + 1; k < (e >> 1); k++) {
|
||||
screen[k][j + o] = '|';
|
||||
screen_color[k][j + o] = 13;
|
||||
}
|
||||
}
|
||||
/* show delayed spectrum in blue */
|
||||
e = s;
|
||||
s = delay[j];
|
||||
if ((s >> 1) < (e >> 1)) {
|
||||
if ((s & 1) == 0)
|
||||
screen[s >> 1][j + o] = '|';
|
||||
else
|
||||
screen[s >> 1][j + o] = '.';
|
||||
screen_color[s >> 1][j + o] = 4;
|
||||
for (k = (s >> 1) + 1; k < (e >> 1); k++) {
|
||||
screen[k][j + o] = '|';
|
||||
screen_color[k][j + o] = 4;
|
||||
}
|
||||
}
|
||||
if (spectrum_on == 2) {
|
||||
/* show hold spectrum in white */
|
||||
s = l = n = hold[j];
|
||||
/* get last and next value */
|
||||
if (j > 0)
|
||||
l = (hold[j - 1] + s) / 2;
|
||||
if (j < fft_size - 1)
|
||||
n = (hold[j + 1] + s) / 2;
|
||||
if (s > l && s > n) {
|
||||
/* hold value is a minimum */
|
||||
e = s;
|
||||
s = (l < n) ? (l + 1) : (n + 1);
|
||||
} else if (s < l && s < n) {
|
||||
/* hold value is a maximum */
|
||||
e = (l > n) ? l : n;
|
||||
} else if (l < n) {
|
||||
/* last value is higher, next value is lower */
|
||||
s = l + 1;
|
||||
e = n;
|
||||
} else if (l > n) {
|
||||
/* last value is lower, next value is higher */
|
||||
s = n + 1;
|
||||
e = l;
|
||||
} else {
|
||||
/* hold, last and next values are equal */
|
||||
e = s;
|
||||
}
|
||||
if (s == e) {
|
||||
if ((s & 1) == 0)
|
||||
screen[s >> 1][j + o] = '\'';
|
||||
else
|
||||
screen[s >> 1][j + o] = '.';
|
||||
screen_color[s >> 1][j + o] = 17;
|
||||
} else {
|
||||
if ((s & 1) == 0)
|
||||
screen[s >> 1][j + o] = '|';
|
||||
else
|
||||
screen[s >> 1][j + o] = '.';
|
||||
screen_color[s >> 1][j + o] = 17;
|
||||
if ((e & 1) == 0)
|
||||
screen[e >> 1][j + o] = '\'';
|
||||
else
|
||||
screen[e >> 1][j + o] = '|';
|
||||
screen_color[e >> 1][j + o] = 17;
|
||||
for (k = (s >> 1) + 1; k < (e >> 1); k++) {
|
||||
screen[k][j + o] = '|';
|
||||
screen_color[k][j + o] = 17;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
/* add channel positions in spectrum */
|
||||
for (mark = disp.mark; mark; mark = mark->next) {
|
||||
j = (int)((mark->frequency - center_frequency) / frequency_range * (double) fft_size + width / 2 + 0.5);
|
||||
if (j < 0 || j >= width) /* check out-of-range, should not happen */
|
||||
continue;
|
||||
for (k = 0; k < HEIGHT; k++) {
|
||||
/* skip yellow/white graph */
|
||||
if (screen_color[k][j] == 13 || screen_color[k][j] == 17)
|
||||
continue;
|
||||
screen[k][j] = ':';
|
||||
screen_color[k][j] = 12;
|
||||
}
|
||||
sprintf(print_channel, "Ch%s", mark->kanal);
|
||||
for (o = 0; o < (int)strlen(print_channel); o++) {
|
||||
s = j - strlen(print_channel) + o;
|
||||
if (s >= 0 && s < width) {
|
||||
screen[HEIGHT - 1][s] = print_channel[o];
|
||||
screen_color[HEIGHT - 1][s] = 7;
|
||||
}
|
||||
}
|
||||
if (fmod(mark->frequency, 1000.0))
|
||||
sprintf(print_frequency, "%.4f", mark->frequency / 1e6);
|
||||
else
|
||||
sprintf(print_frequency, "%.3f", mark->frequency / 1e6);
|
||||
for (o = 0; o < (int)strlen(print_frequency); o++) {
|
||||
s = j + o + 1;
|
||||
if (s >= 0 && s < width) {
|
||||
screen[HEIGHT - 1][s] = print_frequency[o];
|
||||
screen_color[HEIGHT - 1][s] = 7;
|
||||
}
|
||||
}
|
||||
}
|
||||
/* add center (DC line) to spectrum */
|
||||
j = width / 2 + 0.5;
|
||||
if (j < 1 || j >= width-1) /* check out-of-range, should not happen */
|
||||
continue;
|
||||
for (k = 0; k < HEIGHT; k++) {
|
||||
/* skip green/yellow/white graph */
|
||||
if (screen_color[k][j] == 13 || screen_color[k][j] == 17 || screen_color[k][j] == 12)
|
||||
continue;
|
||||
screen[k][j] = '.';
|
||||
screen_color[k][j] = 7;
|
||||
}
|
||||
screen[0][j-1] = 'D';
|
||||
screen[0][j+1] = 'C';
|
||||
screen_color[0][j-1] = 7;
|
||||
screen_color[0][j+1] = 7;
|
||||
/* display buffer */
|
||||
printf("\0337\033[H");
|
||||
for (j = 0; j < HEIGHT; j++) {
|
||||
for (k = 0; k < width; k++) {
|
||||
if (screen_color[j][k] != color) {
|
||||
color = screen_color[j][k];
|
||||
printf("\033[%d;3%dm", color / 10, color % 10);
|
||||
}
|
||||
putchar(screen[j][k]);
|
||||
}
|
||||
printf("\n");
|
||||
}
|
||||
/* reset color and position */
|
||||
printf("\033[0;39m\0338"); fflush(stdout);
|
||||
}
|
||||
}
|
||||
|
||||
disp.interval_pos = pos;
|
||||
|
||||
unlock_debug();
|
||||
}
|
||||
|
||||
|
|
@ -1,145 +0,0 @@
|
|||
/* display status functions
|
||||
*
|
||||
* (C) 2017 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
#include <pthread.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include "../libsample/sample.h"
|
||||
#include "../libdebug/debug.h"
|
||||
#include "../libdisplay/display.h"
|
||||
|
||||
static int status_on = 0;
|
||||
static int line_count = 0;
|
||||
static int lines_total = 0;
|
||||
static char screen[MAX_HEIGHT_STATUS][MAX_DISPLAY_WIDTH];
|
||||
|
||||
static void print_status(int on)
|
||||
{
|
||||
int i, j;
|
||||
int w, h;
|
||||
|
||||
get_win_size(&w, &h);
|
||||
if (w > MAX_DISPLAY_WIDTH - 1)
|
||||
w = MAX_DISPLAY_WIDTH - 1;
|
||||
|
||||
if (w > MAX_DISPLAY_WIDTH)
|
||||
w = MAX_DISPLAY_WIDTH;
|
||||
h--;
|
||||
if (h > lines_total)
|
||||
h = lines_total;
|
||||
|
||||
lock_debug();
|
||||
printf("\0337\033[H\033[1;37m");
|
||||
for (i = 0; i < h; i++) {
|
||||
j = 0;
|
||||
if (on) {
|
||||
for (j = 0; j < w; j++)
|
||||
putchar(screen[i][j]);
|
||||
} else {
|
||||
for (j = 0; j < w; j++)
|
||||
putchar(' ');
|
||||
}
|
||||
putchar('\n');
|
||||
}
|
||||
printf("\0338"); fflush(stdout);
|
||||
unlock_debug();
|
||||
}
|
||||
|
||||
void display_status_on(int on)
|
||||
{
|
||||
if (status_on)
|
||||
print_status(0);
|
||||
|
||||
if (on < 0)
|
||||
status_on = 1 - status_on;
|
||||
else
|
||||
status_on = on;
|
||||
|
||||
if (status_on)
|
||||
print_status(1);
|
||||
|
||||
if (status_on)
|
||||
debug_limit_scroll = lines_total;
|
||||
else
|
||||
debug_limit_scroll = 0;
|
||||
}
|
||||
|
||||
/* start status display */
|
||||
void display_status_start(void)
|
||||
{
|
||||
memset(screen, ' ', sizeof(screen));
|
||||
memset(screen[0], '-', sizeof(screen[0]));
|
||||
memcpy(screen[0] + 4, "Channel Status", 14);
|
||||
line_count = 1;
|
||||
}
|
||||
|
||||
void display_status_channel(const char *kanal, const char *type, const char *state)
|
||||
{
|
||||
char line[MAX_DISPLAY_WIDTH];
|
||||
|
||||
/* add empty line after previous channel+subscriber */
|
||||
if (line_count > 1 && line_count < MAX_HEIGHT_STATUS)
|
||||
line_count++;
|
||||
|
||||
if (line_count == MAX_HEIGHT_STATUS)
|
||||
return;
|
||||
|
||||
if (type)
|
||||
snprintf(line, sizeof(line), "Channel: %s Type: %s State: %s", kanal, type, state);
|
||||
else
|
||||
snprintf(line, sizeof(line), "Channel: %s State: %s", kanal, state);
|
||||
line[sizeof(line) - 1] = '\0';
|
||||
memcpy(screen[line_count++], line, strlen(line));
|
||||
}
|
||||
|
||||
void display_status_subscriber(const char *number, const char *state)
|
||||
{
|
||||
char line[MAX_DISPLAY_WIDTH];
|
||||
|
||||
if (line_count == MAX_HEIGHT_STATUS)
|
||||
return;
|
||||
|
||||
if (state)
|
||||
snprintf(line, sizeof(line), " Subscriber: %s State: %s", number, state);
|
||||
else
|
||||
snprintf(line, sizeof(line), " Subscriber: %s", number);
|
||||
line[sizeof(line) - 1] = '\0';
|
||||
memcpy(screen[line_count++], line, strlen(line));
|
||||
}
|
||||
|
||||
void display_status_end(void)
|
||||
{
|
||||
if (line_count < MAX_HEIGHT_STATUS) {
|
||||
memset(screen[line_count], '-', sizeof(screen[line_count]));
|
||||
line_count++;
|
||||
}
|
||||
/* if last total lines exceed current line count, keep it, so removed lines are overwritten with spaces */
|
||||
if (line_count > lines_total)
|
||||
lines_total = line_count;
|
||||
if (status_on)
|
||||
print_status(1);
|
||||
/* set new total lines */
|
||||
lines_total = line_count;
|
||||
if (status_on)
|
||||
debug_limit_scroll = lines_total;
|
||||
}
|
||||
|
||||
|
|
@ -1,252 +0,0 @@
|
|||
/* display wave form functions
|
||||
*
|
||||
* (C) 2016 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
#include <pthread.h>
|
||||
#include <math.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include "../libsample/sample.h"
|
||||
#include "../libdebug/debug.h"
|
||||
#include "../libdisplay/display.h"
|
||||
|
||||
#define HEIGHT 11
|
||||
|
||||
static int num_sender = 0;
|
||||
static char screen[HEIGHT][MAX_DISPLAY_WIDTH];
|
||||
static int wave_on = 0;
|
||||
|
||||
void display_wave_init(dispwav_t *disp, int samplerate, const char *kanal)
|
||||
{
|
||||
memset(disp, 0, sizeof(*disp));
|
||||
disp->offset = (num_sender++) * HEIGHT;
|
||||
disp->interval_max = (double)samplerate * DISPLAY_INTERVAL + 0.5;
|
||||
disp->kanal = kanal;
|
||||
}
|
||||
|
||||
void display_wave_on(int on)
|
||||
{
|
||||
int i, j;
|
||||
int w, h;
|
||||
|
||||
get_win_size(&w, &h);
|
||||
if (w > MAX_DISPLAY_WIDTH - 1)
|
||||
w = MAX_DISPLAY_WIDTH - 1;
|
||||
|
||||
if (wave_on) {
|
||||
memset(&screen, ' ', sizeof(screen));
|
||||
lock_debug();
|
||||
printf("\0337\033[H");
|
||||
for (i = 0; i < num_sender; i++) {
|
||||
for (j = 0; j < HEIGHT; j++) {
|
||||
screen[j][w] = '\0';
|
||||
puts(screen[j]);
|
||||
}
|
||||
}
|
||||
printf("\0338"); fflush(stdout);
|
||||
unlock_debug();
|
||||
}
|
||||
|
||||
if (on < 0)
|
||||
wave_on = 1 - wave_on;
|
||||
else
|
||||
wave_on = on;
|
||||
|
||||
if (wave_on)
|
||||
debug_limit_scroll = HEIGHT * num_sender;
|
||||
else
|
||||
debug_limit_scroll = 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* draw wave form:
|
||||
*
|
||||
* theoretical example: HEIGHT = 3 allows 5 steps
|
||||
*
|
||||
* Line 0: '.
|
||||
* Line 1: '.
|
||||
* Line 2: '
|
||||
*
|
||||
* HEIGHT is odd, so the center line's char is ''' (otherwise '.')
|
||||
* (HEIGHT - 1) / 2 = 1, so the center line is drawn in line 1
|
||||
*
|
||||
* y is in range of 0..4, so these are 5 steps, where 2 is the
|
||||
* center line. this is calculated by (HEIGHT * 2 - 1)
|
||||
*/
|
||||
void display_wave(dispwav_t *disp, sample_t *samples, int length, double range)
|
||||
{
|
||||
int pos, max;
|
||||
sample_t *buffer;
|
||||
int i, j, k, s, e;
|
||||
double last, current, next;
|
||||
int color = 9; /* default color */
|
||||
int center_line;
|
||||
char center_char;
|
||||
int width, h;
|
||||
|
||||
if (!wave_on)
|
||||
return;
|
||||
|
||||
lock_debug();
|
||||
|
||||
get_win_size(&width, &h);
|
||||
if (width > MAX_DISPLAY_WIDTH - 1)
|
||||
width = MAX_DISPLAY_WIDTH - 1;
|
||||
|
||||
/* at what line we draw our zero-line and what character we use */
|
||||
center_line = (HEIGHT - 1) >> 1;
|
||||
center_char = (HEIGHT & 1) ? '\'' : '.';
|
||||
|
||||
pos = disp->interval_pos;
|
||||
max = disp->interval_max;
|
||||
buffer = disp->buffer;
|
||||
|
||||
for (i = 0; i < length; i++) {
|
||||
if (pos >= width + 2) {
|
||||
if (++pos == max)
|
||||
pos = 0;
|
||||
continue;
|
||||
}
|
||||
buffer[pos++] = samples[i];
|
||||
if (pos == width + 2) {
|
||||
memset(&screen, ' ', sizeof(screen));
|
||||
for (j = 0; j < width; j++) {
|
||||
/* Input value is scaled to range -1 .. 1 and then subtracted from 1,
|
||||
* so the result ranges from 0 .. 2.
|
||||
* HEIGHT-1 is multiplied with the range, so a HEIGHT of 3 would allow
|
||||
* 0..4 (5 steps) and a HEIGHT of 11 would allow 0..20 (21 steps).
|
||||
* We always use odd number of steps, so there will be a center between
|
||||
* values.
|
||||
*/
|
||||
last = (1.0 - buffer[j] / range) * (double)(HEIGHT - 1);
|
||||
current = (1.0 - buffer[j + 1] / range) * (double)(HEIGHT - 1);
|
||||
next = (1.0 - buffer[j + 2] / range) * (double)(HEIGHT - 1);
|
||||
/* calculate start and end for vertical line
|
||||
* if the current value is a peak (above or below last AND next point),
|
||||
* round this peak point to become one end of the vertical line.
|
||||
* the other end is rounded up or down, so the end of the line will
|
||||
* not overlap with the ends of the surrounding lines.
|
||||
*/
|
||||
if (last > current) {
|
||||
if (next > current) {
|
||||
/* current point is a peak up */
|
||||
s = round(current);
|
||||
/* use lowest neighbor point and end is half way */
|
||||
if (last > next)
|
||||
e = floor((last + current) / 2.0);
|
||||
else
|
||||
e = floor((next + current) / 2.0);
|
||||
/* end point must not be above start point */
|
||||
if (e < s)
|
||||
e = s;
|
||||
} else {
|
||||
/* current point is a transition upwards */
|
||||
s = ceil((next + current) / 2.0);
|
||||
e = floor((last + current) / 2.0);
|
||||
/* end point must not be above start point */
|
||||
if (e < s)
|
||||
s = e = round(current);
|
||||
}
|
||||
} else {
|
||||
if (next <= current) {
|
||||
/* current point is a peak down */
|
||||
e = round(current);
|
||||
/* use heighes neighbor point and start is half way */
|
||||
if (last <= next)
|
||||
s = ceil((last + current) / 2.0);
|
||||
else
|
||||
s = ceil((next + current) / 2.0);
|
||||
/* start point must not be below end point */
|
||||
if (s > e)
|
||||
s = e;
|
||||
} else {
|
||||
/* current point is a transition downwards */
|
||||
s = ceil((last + current) / 2.0);
|
||||
e = floor((next + current) / 2.0);
|
||||
/* start point must not be below end point */
|
||||
if (s > e)
|
||||
s = e = round(current);
|
||||
}
|
||||
}
|
||||
/* only draw line, if it is in range */
|
||||
if (e >= 0 && s < HEIGHT * 2 - 1) {
|
||||
/* clip */
|
||||
if (s < 0)
|
||||
s = 0;
|
||||
if (e >= HEIGHT * 2 - 1)
|
||||
e = HEIGHT * 2 - 1;
|
||||
/* plot start and end point */
|
||||
if ((s & 1))
|
||||
screen[s >> 1][j] = '.';
|
||||
else if (e != s)
|
||||
screen[s >> 1][j] = '|';
|
||||
if (!(e & 1))
|
||||
screen[e >> 1][j] = '\'';
|
||||
else if (e != s)
|
||||
screen[e >> 1][j] = '|';
|
||||
/* plot line between start and end point */
|
||||
for (k = (s >> 1) + 1; k < (e >> 1); k++)
|
||||
screen[k][j] = '|';
|
||||
}
|
||||
}
|
||||
sprintf(screen[0], "(chan %s", disp->kanal);
|
||||
*strchr(screen[0], '\0') = ')';
|
||||
printf("\0337\033[H");
|
||||
for (j = 0; j < disp->offset; j++)
|
||||
puts("");
|
||||
for (j = 0; j < HEIGHT; j++) {
|
||||
for (k = 0; k < width; k++) {
|
||||
if (j == center_line && screen[j][k] == ' ') {
|
||||
/* blue 0-line */
|
||||
if (color != 4) {
|
||||
color = 4;
|
||||
printf("\033[0;34m");
|
||||
}
|
||||
putchar(center_char);
|
||||
} else if (screen[j][k] == '\'' || screen[j][k] == '.' || screen[j][k] == '|') {
|
||||
/* green scope curve */
|
||||
if (color != 2) {
|
||||
color = 2;
|
||||
printf("\033[1;32m");
|
||||
}
|
||||
putchar(screen[j][k]);
|
||||
} else if (screen[j][k] != ' ') {
|
||||
/* white other characters */
|
||||
if (color != 7) {
|
||||
color = 7;
|
||||
printf("\033[1;37m");
|
||||
}
|
||||
putchar(screen[j][k]);
|
||||
} else
|
||||
putchar(screen[j][k]);
|
||||
}
|
||||
printf("\n");
|
||||
}
|
||||
/* reset color and position */
|
||||
printf("\033[0;39m\0338"); fflush(stdout);
|
||||
}
|
||||
}
|
||||
|
||||
disp->interval_pos = pos;
|
||||
|
||||
unlock_debug();
|
||||
}
|
||||
|
||||
|
|
@ -1,8 +0,0 @@
|
|||
AM_CPPFLAGS = -Wall -Wextra -g $(all_includes)
|
||||
|
||||
noinst_LIBRARIES = libfilter.a
|
||||
|
||||
libfilter_a_SOURCES = \
|
||||
iir_filter.c \
|
||||
fir_filter.c
|
||||
|
|
@ -1,197 +0,0 @@
|
|||
/* FIR filter
|
||||
*
|
||||
* (C) 2017 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
#include <stdlib.h>
|
||||
#include <math.h>
|
||||
#include "../libsample/sample.h"
|
||||
#include "fir_filter.h"
|
||||
|
||||
//#define DEBUG_TAPS
|
||||
|
||||
static void kernel(double *taps, int M, double cutoff, int invert)
|
||||
{
|
||||
int i;
|
||||
double sum;
|
||||
|
||||
for (i = 0; i <= M; i++) {
|
||||
/* gen sinc */
|
||||
if (i == M / 2)
|
||||
taps[i] = 2.0 * M_PI * cutoff;
|
||||
else
|
||||
taps[i] = sin(2.0 * M_PI * cutoff * (double)(i - M / 2))
|
||||
/ (double)(i - M / 2);
|
||||
/* blackman window */
|
||||
taps[i] *= 0.42 - 0.50 * cos(2 * M_PI * (double)(i / M))
|
||||
+ 0.08 * cos(4 * M_PI * (double)(i / M));
|
||||
}
|
||||
|
||||
/* normalize */
|
||||
sum = 0;
|
||||
for (i = 0; i <= M; i++)
|
||||
sum += taps[i];
|
||||
for (i = 0; i <= M; i++)
|
||||
taps[i] /= sum;
|
||||
|
||||
/* invert */
|
||||
if (invert) {
|
||||
for (i = 0; i <= M; i++)
|
||||
taps[i] = -taps[i];
|
||||
taps[M / 2] += 1.0;
|
||||
}
|
||||
|
||||
#ifdef DEBUG_TAPS
|
||||
puts("start");
|
||||
for (i = 0; i <= M; i++)
|
||||
puts(debug_amplitude(taps[i]));
|
||||
#endif
|
||||
}
|
||||
|
||||
static fir_filter_t *fir_init(double samplerate, double transition_bandwidth)
|
||||
{
|
||||
fir_filter_t *fir;
|
||||
int M;
|
||||
|
||||
/* alloc struct */
|
||||
fir = calloc(1, sizeof(*fir));
|
||||
if (!fir) {
|
||||
fprintf(stderr, "No memory creating FIR filter!\n");
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* transition bandwidth */
|
||||
M = ceil(1.0 / (transition_bandwidth / samplerate));
|
||||
if ((M & 1))
|
||||
M++;
|
||||
|
||||
// printf("cutoff=%.4f\n", cutoff / samplerate);
|
||||
// printf("tb=%.4f\n", transition_bandwidth / samplerate);
|
||||
fir->ntaps = M + 1;
|
||||
fir->delay = M / 2;
|
||||
|
||||
/* alloc taps */
|
||||
fir->taps = calloc(fir->ntaps, sizeof(*fir->taps));
|
||||
if (!fir->taps) {
|
||||
fprintf(stderr, "No memory creating FIR filter!\n");
|
||||
fir_exit(fir);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* alloc ring buffer */
|
||||
fir->buffer = calloc(fir->ntaps, sizeof(*fir->buffer));
|
||||
if (!fir->buffer) {
|
||||
fprintf(stderr, "No memory creating FIR filter!\n");
|
||||
fir_exit(fir);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
|
||||
return fir;
|
||||
}
|
||||
|
||||
fir_filter_t *fir_lowpass_init(double samplerate, double cutoff, double transition_bandwidth)
|
||||
{
|
||||
/* calculate kernel */
|
||||
fir_filter_t *fir = fir_init(samplerate, transition_bandwidth);
|
||||
if (!fir)
|
||||
return NULL;
|
||||
kernel(fir->taps, fir->ntaps - 1, cutoff / samplerate, 0);
|
||||
return fir;
|
||||
}
|
||||
|
||||
fir_filter_t *fir_highpass_init(double samplerate, double cutoff, double transition_bandwidth)
|
||||
{
|
||||
fir_filter_t *fir = fir_init(samplerate, transition_bandwidth);
|
||||
if (!fir)
|
||||
return NULL;
|
||||
kernel(fir->taps, fir->ntaps - 1, cutoff / samplerate, 1);
|
||||
return fir;
|
||||
}
|
||||
|
||||
fir_filter_t *fir_allpass_init(double samplerate, double transition_bandwidth)
|
||||
{
|
||||
fir_filter_t *fir = fir_init(samplerate, transition_bandwidth);
|
||||
if (!fir)
|
||||
return NULL;
|
||||
fir->taps[(fir->ntaps - 1) / 2] = 1.0;
|
||||
return fir;
|
||||
}
|
||||
|
||||
fir_filter_t *fir_twopass_init(double samplerate, double cutoff_low, double cutoff_high, double transition_bandwidth)
|
||||
{
|
||||
int i;
|
||||
double sum;
|
||||
fir_filter_t *fir = fir_init(samplerate, transition_bandwidth);
|
||||
if (!fir)
|
||||
return NULL;
|
||||
double lp_taps[fir->ntaps], hp_taps[fir->ntaps];
|
||||
kernel(lp_taps, fir->ntaps - 1, cutoff_low / samplerate, 0);
|
||||
kernel(hp_taps, fir->ntaps - 1, cutoff_high / samplerate, 1);
|
||||
sum = 0;
|
||||
printf("#warning does not work as expected\n");
|
||||
abort();
|
||||
for (i = 0; i < fir->ntaps; i++) {
|
||||
fir->taps[i] = lp_taps[i] + hp_taps[i];
|
||||
sum += fir->taps[i];
|
||||
}
|
||||
/* hp will die */
|
||||
// for (i = 0; i < fir->ntaps; i++)
|
||||
// fir->taps[i] /= sum;
|
||||
return fir;
|
||||
}
|
||||
|
||||
void fir_exit(fir_filter_t *fir)
|
||||
{
|
||||
if (!fir)
|
||||
return;
|
||||
free(fir->taps);
|
||||
free(fir->buffer);
|
||||
free(fir);
|
||||
}
|
||||
|
||||
void fir_process(fir_filter_t *fir, sample_t *samples, int num)
|
||||
{
|
||||
int i, j;
|
||||
double y;
|
||||
|
||||
for (i = 0; i < num; i++) {
|
||||
/* put sample in ring buffer */
|
||||
fir->buffer[fir->buffer_pos] = samples[i];
|
||||
if (++fir->buffer_pos == fir->ntaps)
|
||||
fir->buffer_pos = 0;
|
||||
|
||||
/* convolve samples */
|
||||
y = 0;
|
||||
for (j = 0; j < fir->ntaps; j++) {
|
||||
/* convolve sample from ring buffer, starting with oldest */
|
||||
y += fir->buffer[fir->buffer_pos] * fir->taps[j];
|
||||
if (++fir->buffer_pos == fir->ntaps)
|
||||
fir->buffer_pos = 0;
|
||||
}
|
||||
samples[i] = y;
|
||||
}
|
||||
}
|
||||
|
||||
int fir_get_delay(fir_filter_t *fir)
|
||||
{
|
||||
return fir->delay;
|
||||
}
|
||||
|
|
@ -1,21 +0,0 @@
|
|||
#ifndef _FIR_FILTER_H
|
||||
#define _FIR_FILTER_H
|
||||
|
||||
typedef struct fir_filter {
|
||||
int ntaps;
|
||||
int delay;
|
||||
double *taps;
|
||||
double *buffer;
|
||||
int buffer_pos;
|
||||
} fir_filter_t;
|
||||
|
||||
fir_filter_t *fir_lowpass_init(double samplerate, double cutoff, double transition_bandwidth);
|
||||
fir_filter_t *fir_highpass_init(double samplerate, double cutoff, double transition_bandwidth);
|
||||
fir_filter_t *fir_allpass_init(double samplerate, double transition_bandwidth);
|
||||
fir_filter_t *fir_twopass_init(double samplerate, double cutoff_low, double cutoff_high, double transition_bandwidth);
|
||||
void fir_exit(fir_filter_t *fir);
|
||||
void fir_process(fir_filter_t *fir, sample_t *samples, int num);
|
||||
int fir_get_delay(fir_filter_t *fir);
|
||||
|
||||
#endif /* _FIR_FILTER_H */
|
||||
|
|
@ -1,204 +0,0 @@
|
|||
/* cut-off filter (biquad) based on Nigel Redmon (www.earlevel.com)
|
||||
*
|
||||
* (C) 2016 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
#include <stdlib.h>
|
||||
#include <math.h>
|
||||
#include "../libsample/sample.h"
|
||||
#include "iir_filter.h"
|
||||
|
||||
//#define DEBUG_NAN
|
||||
|
||||
#define PI M_PI
|
||||
|
||||
void iir_lowpass_init(iir_filter_t *filter, double frequency, int samplerate, int iterations)
|
||||
{
|
||||
double Fc, Q, K, norm;
|
||||
|
||||
if (iterations > 64) {
|
||||
fprintf(stderr, "%s failed: too many iterations, please fix!\n", __func__);
|
||||
abort();
|
||||
}
|
||||
|
||||
memset(filter, 0, sizeof(*filter));
|
||||
filter->iter = iterations;
|
||||
Q = pow(sqrt(0.5), 1.0 / (double)iterations); /* 0.7071 @ 1 iteration */
|
||||
Fc = frequency / (double)samplerate;
|
||||
K = tan(PI * Fc);
|
||||
norm = 1 / (1 + K / Q + K * K);
|
||||
filter->a0 = K * K * norm;
|
||||
filter->a1 = 2 * filter->a0;
|
||||
filter->a2 = filter->a0;
|
||||
filter->b1 = 2 * (K * K - 1) * norm;
|
||||
filter->b2 = (1 - K / Q + K * K) * norm;
|
||||
#ifdef DEBUG_NAN
|
||||
printf("%p\n", filter);
|
||||
#endif
|
||||
}
|
||||
|
||||
void iir_highpass_init(iir_filter_t *filter, double frequency, int samplerate, int iterations)
|
||||
{
|
||||
double Fc, Q, K, norm;
|
||||
|
||||
memset(filter, 0, sizeof(*filter));
|
||||
filter->iter = iterations;
|
||||
Q = pow(sqrt(0.5), 1.0 / (double)iterations); /* 0.7071 @ 1 iteration */
|
||||
Fc = frequency / (double)samplerate;
|
||||
K = tan(PI * Fc);
|
||||
norm = 1 / (1 + K / Q + K * K);
|
||||
filter->a0 = 1 * norm;
|
||||
filter->a1 = -2 * filter->a0;
|
||||
filter->a2 = filter->a0;
|
||||
filter->b1 = 2 * (K * K - 1) * norm;
|
||||
filter->b2 = (1 - K / Q + K * K) * norm;
|
||||
}
|
||||
|
||||
void iir_bandpass_init(iir_filter_t *filter, double frequency, int samplerate, int iterations)
|
||||
{
|
||||
double Fc, Q, K, norm;
|
||||
|
||||
memset(filter, 0, sizeof(*filter));
|
||||
filter->iter = iterations;
|
||||
Q = pow(sqrt(0.5), 1.0 / (double)iterations); /* 0.7071 @ 1 iteration */
|
||||
Fc = frequency / (double)samplerate;
|
||||
K = tan(PI * Fc);
|
||||
norm = 1 / (1 + K / Q + K * K);
|
||||
filter->a0 = K / Q * norm;
|
||||
filter->a1 = 0;
|
||||
filter->a2 = -filter->a0;
|
||||
filter->b1 = 2 * (K * K - 1) * norm;
|
||||
filter->b2 = (1 - K / Q + K * K) * norm;
|
||||
}
|
||||
|
||||
void iir_notch_init(iir_filter_t *filter, double frequency, int samplerate, int iterations)
|
||||
{
|
||||
double Fc, Q, K, norm;
|
||||
|
||||
memset(filter, 0, sizeof(*filter));
|
||||
filter->iter = iterations;
|
||||
Q = pow(sqrt(0.5), 1.0 / (double)iterations); /* 0.7071 @ 1 iteration */
|
||||
Fc = frequency / (double)samplerate;
|
||||
K = tan(PI * Fc);
|
||||
norm = 1 / (1 + K / Q + K * K);
|
||||
filter->a0 = (1 + K * K) * norm;
|
||||
filter->a1 = 2 * (K * K - 1) * norm;
|
||||
filter->a2 = filter->a0;
|
||||
filter->b1 = filter->a1;
|
||||
filter->b2 = (1 - K / Q + K * K) * norm;
|
||||
}
|
||||
|
||||
void iir_process(iir_filter_t *filter, sample_t *samples, int length)
|
||||
{
|
||||
double a0, a1, a2, b1, b2;
|
||||
double *z1, *z2;
|
||||
double in, out;
|
||||
int iterations = filter->iter;
|
||||
int i, j;
|
||||
|
||||
/* get states */
|
||||
a0 = filter->a0;
|
||||
a1 = filter->a1;
|
||||
a2 = filter->a2;
|
||||
b1 = filter->b1;
|
||||
b2 = filter->b2;
|
||||
|
||||
/* these are state pointers, so no need to write back */
|
||||
z1 = filter->z1;
|
||||
z2 = filter->z2;
|
||||
|
||||
/* process filter */
|
||||
for (i = 0; i < length; i++) {
|
||||
/* add a small value, otherwise this loop will perform really bad on my 'nuedel' machine!!! */
|
||||
in = *samples + 0.000000001;
|
||||
for (j = 0; j < iterations; j++) {
|
||||
out = in * a0 + z1[j];
|
||||
z1[j] = in * a1 + z2[j] - b1 * out;
|
||||
z2[j] = in * a2 - b2 * out;
|
||||
in = out;
|
||||
}
|
||||
*samples++ = in;
|
||||
}
|
||||
}
|
||||
|
||||
#ifdef DEBUG_NAN
|
||||
#pragma GCC push_options
|
||||
//#pragma GCC optimize ("O0")
|
||||
#endif
|
||||
|
||||
void iir_process_baseband(iir_filter_t *filter, float *baseband, int length)
|
||||
{
|
||||
double a0, a1, a2, b1, b2;
|
||||
double *z1, *z2;
|
||||
double in, out;
|
||||
int iterations = filter->iter;
|
||||
int i, j;
|
||||
|
||||
/* get states */
|
||||
a0 = filter->a0;
|
||||
a1 = filter->a1;
|
||||
a2 = filter->a2;
|
||||
b1 = filter->b1;
|
||||
b2 = filter->b2;
|
||||
|
||||
/* these are state pointers, so no need to write back */
|
||||
z1 = filter->z1;
|
||||
z2 = filter->z2;
|
||||
|
||||
/* process filter */
|
||||
for (i = 0; i < length; i++) {
|
||||
/* add a small value, otherwise this loop will perform really bad on my 'nuedel' machine!!! */
|
||||
in = *baseband + 0.000000001;
|
||||
for (j = 0; j < iterations; j++) {
|
||||
out = in * a0 + z1[j];
|
||||
#ifdef DEBUG_NAN
|
||||
if (!(out > -100 && out < 100)) {
|
||||
printf("%p\n", filter);
|
||||
printf("1. i=%d j=%d z=%.5f in=%.5f a0=%.5f out=%.5f\n", i, j, z1[j], in, a0, out);
|
||||
abort();
|
||||
}
|
||||
#endif
|
||||
z1[j] = in * a1 + z2[j] - b1 * out;
|
||||
#ifdef DEBUG_NAN
|
||||
if (!(z1[j] > -100 && z1[j] < 100)) {
|
||||
printf("%p\n", filter);
|
||||
printf("2. i=%d j=%d z1=%.5f z2=%.5f in=%.5f a1=%.5f out=%.5f b1=%.5f\n", i, j, z1[j], z2[j], in, a1, out, b1);
|
||||
abort();
|
||||
}
|
||||
#endif
|
||||
z2[j] = in * a2 - b2 * out;
|
||||
#ifdef DEBUG_NAN
|
||||
if (!(z2[j] > -100 && z2[j] < 100)) {
|
||||
printf("%p\n", filter);
|
||||
printf("%.5f\n", (in * a2) - (b2 * out));
|
||||
printf("3. i=%d j=%d z2=%.5f in=%.5f a2=%.5f b2=%.5f out=%.5f\n", i, j, z2[j], in, a2, b2, out);
|
||||
abort();
|
||||
}
|
||||
#endif
|
||||
in = out;
|
||||
}
|
||||
*baseband = in;
|
||||
baseband += 2;
|
||||
}
|
||||
}
|
||||
|
||||
#ifdef DEBUG_NAN
|
||||
#pragma GCC pop_options
|
||||
#endif
|
|
@ -1,17 +0,0 @@
|
|||
#ifndef _FILTER_H
|
||||
#define _FILTER_H
|
||||
|
||||
typedef struct iir_filter {
|
||||
int iter;
|
||||
double a0, a1, a2, b1, b2;
|
||||
double z1[64], z2[64];
|
||||
} iir_filter_t;
|
||||
|
||||
void iir_lowpass_init(iir_filter_t *filter, double frequency, int samplerate, int iterations);
|
||||
void iir_highpass_init(iir_filter_t *filter, double frequency, int samplerate, int iterations);
|
||||
void iir_bandpass_init(iir_filter_t *filter, double frequency, int samplerate, int iterations);
|
||||
void iir_notch_init(iir_filter_t *filter, double frequency, int samplerate, int iterations);
|
||||
void iir_process(iir_filter_t *filter, sample_t *samples, int length);
|
||||
void iir_process_baseband(iir_filter_t *filter, float *baseband, int length);
|
||||
|
||||
#endif /* _FILTER_H */
|
|
@ -1,7 +0,0 @@
|
|||
AM_CPPFLAGS = -Wall -Wextra -g $(all_includes)
|
||||
|
||||
noinst_LIBRARIES = liboptions.a
|
||||
|
||||
liboptions_a_SOURCES = \
|
||||
options.c
|
||||
|
|
@ -1,339 +0,0 @@
|
|||
/* command line options and config file parsing
|
||||
*
|
||||
* (C) 2018 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
#include <stdlib.h>
|
||||
#include <errno.h>
|
||||
#include "options.h"
|
||||
#include "../libdebug/debug.h"
|
||||
|
||||
typedef struct option {
|
||||
struct option *next;
|
||||
int short_option;
|
||||
const char *long_option;
|
||||
int parameter_count;
|
||||
} option_t;
|
||||
|
||||
static option_t *option_head = NULL;
|
||||
static option_t **option_tailp = &option_head;
|
||||
static int first_option = 1;
|
||||
|
||||
static struct options_strdup_entry {
|
||||
struct options_strdup_entry *next;
|
||||
char s[1];
|
||||
} *options_strdup_list = NULL;
|
||||
|
||||
char *options_strdup(const char *s)
|
||||
{
|
||||
struct options_strdup_entry *o;
|
||||
|
||||
o = malloc(sizeof(struct options_strdup_entry) + strlen(s));
|
||||
if (!o) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "No mem!\n");
|
||||
abort();
|
||||
}
|
||||
o->next = options_strdup_list;
|
||||
options_strdup_list = o;
|
||||
strcpy(o->s, s);
|
||||
|
||||
return o->s;
|
||||
}
|
||||
|
||||
void option_add(int short_option, const char *long_option, int parameter_count)
|
||||
{
|
||||
option_t *option;
|
||||
|
||||
/* check if option already exists or is not allowed */
|
||||
for (option = option_head; option; option = option->next) {
|
||||
if (!strcmp(option->long_option, "config")) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "Option '%s' is not allowed to add, please fix!\n", option->long_option);
|
||||
abort();
|
||||
}
|
||||
if (option->short_option == short_option
|
||||
|| !strcmp(option->long_option, long_option)) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "Option '%s' added twice, please fix!\n", option->long_option);
|
||||
abort();
|
||||
}
|
||||
}
|
||||
|
||||
option = calloc(1, sizeof(*option));
|
||||
if (!option) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "No mem!\n");
|
||||
abort();
|
||||
}
|
||||
|
||||
option->short_option = short_option;
|
||||
option->long_option = long_option;
|
||||
option->parameter_count = parameter_count;
|
||||
*option_tailp = option;
|
||||
option_tailp = &(option->next);
|
||||
}
|
||||
|
||||
int options_config_file(int argc, char *argv[], const char *config_file, int (*handle_options)(int short_option, int argi, char *argv[]))
|
||||
{
|
||||
static const char *home;
|
||||
char config[256];
|
||||
FILE *fp;
|
||||
char buffer[256], opt[256], param[256], *p, *args[16];
|
||||
char params[1024];
|
||||
int line;
|
||||
int rc = 1;
|
||||
int i, j, quote;
|
||||
option_t *option;
|
||||
|
||||
/* select for alternative config file */
|
||||
if (argc > 2 && !strcmp(argv[1], "--config"))
|
||||
config_file = argv[2];
|
||||
|
||||
/* add home directory */
|
||||
if (config_file[0] == '~' && config_file[1] == '/') {
|
||||
home = getenv("HOME");
|
||||
if (home == NULL)
|
||||
return 1;
|
||||
sprintf(config, "%s/%s", home, config_file + 2);
|
||||
} else
|
||||
strcpy(config, config_file);
|
||||
|
||||
/* open config file */
|
||||
fp = fopen(config, "r");
|
||||
if (!fp) {
|
||||
PDEBUG(DOPTIONS, DEBUG_INFO, "Config file '%s' seems not to exist, using command line options only.\n", config);
|
||||
return 1;
|
||||
}
|
||||
|
||||
/* parse config file */
|
||||
line = 0;
|
||||
while((fgets(buffer, sizeof(buffer), fp))) {
|
||||
line++;
|
||||
/* prevent buffer overflow */
|
||||
buffer[sizeof(buffer) - 1] = '\0';
|
||||
/* cut away new-line and white spaces */
|
||||
while (buffer[0] && buffer[strlen(buffer) - 1] <= ' ')
|
||||
buffer[strlen(buffer) - 1] = '\0';
|
||||
p = buffer;
|
||||
/* remove white spaces in front of first keyword */
|
||||
while (*p > '\0' && *p <= ' ')
|
||||
p++;
|
||||
/* ignore '#' lines */
|
||||
if (*p == '#')
|
||||
continue;
|
||||
/* get option form line */
|
||||
i = 0;
|
||||
while (*p > ' ')
|
||||
opt[i++] = *p++;
|
||||
opt[i] = '\0';
|
||||
if (opt[0] == '\0')
|
||||
continue;
|
||||
/* skip white spaces behind option */
|
||||
while (*p > '\0' && *p <= ' ')
|
||||
p++;
|
||||
/* get param from line */
|
||||
params[0] = '\0';
|
||||
i = 0;
|
||||
while (*p) {
|
||||
/* copy parameter */
|
||||
j = 0;
|
||||
quote = 0;
|
||||
while (*p) {
|
||||
/* escape allows all following characters */
|
||||
if (*p == '\\') {
|
||||
p++;
|
||||
if (*p)
|
||||
param[j++] = *p++;
|
||||
continue;
|
||||
}
|
||||
/* no quote, check for them or break on white space */
|
||||
if (quote == 0) {
|
||||
if (*p == '\'') {
|
||||
quote = 1;
|
||||
p++;
|
||||
continue;
|
||||
}
|
||||
if (*p == '\"') {
|
||||
quote = 2;
|
||||
p++;
|
||||
continue;
|
||||
}
|
||||
if (*p <= ' ')
|
||||
break;
|
||||
}
|
||||
/* single quote, check for unquote */
|
||||
if (quote == 1 && *p == '\'') {
|
||||
quote = 0;
|
||||
p++;
|
||||
continue;
|
||||
}
|
||||
/* double quote, check for unquote */
|
||||
if (quote == 2 && *p == '\"') {
|
||||
quote = 0;
|
||||
p++;
|
||||
continue;
|
||||
}
|
||||
/* copy character */
|
||||
param[j++] = *p++;
|
||||
}
|
||||
param[j] = '\0';
|
||||
args[i] = options_strdup(param);
|
||||
sprintf(strchr(params, '\0'), " '%s'", param);
|
||||
/* skip white spaces behind option */
|
||||
while (*p > '\0' && *p <= ' ')
|
||||
p++;
|
||||
i++;
|
||||
}
|
||||
/* search option */
|
||||
for (option = option_head; option; option = option->next) {
|
||||
if (opt[0] == option->short_option && opt[1] == '\0') {
|
||||
PDEBUG(DOPTIONS, DEBUG_INFO, "Config file option '%s' ('%s'), parameter%s\n", opt, option->long_option, params);
|
||||
break;
|
||||
}
|
||||
if (!strcmp(opt, option->long_option)) {
|
||||
PDEBUG(DOPTIONS, DEBUG_INFO, "Config file option '%s', parameter%s\n", opt, params);
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (!option) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "Given option '%s' in config file '%s' at line %d is not a valid option, use '-h' for help!\n", opt, config_file, line);
|
||||
rc = -EINVAL;
|
||||
goto done;
|
||||
}
|
||||
if (option->parameter_count != i) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "Given option '%s' in config file '%s' at line %d requires %d parameter(s), use '-h' for help!\n", opt, config_file, line, option->parameter_count);
|
||||
return -EINVAL;
|
||||
}
|
||||
rc = handle_options(option->short_option, 0, args);
|
||||
if (rc <= 0)
|
||||
goto done;
|
||||
first_option = 0;
|
||||
}
|
||||
|
||||
done:
|
||||
/* close config file */
|
||||
fclose(fp);
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
int options_command_line(int argc, char *argv[], int (*handle_options)(int short_option, int argi, char *argv[]))
|
||||
{
|
||||
option_t *option;
|
||||
char params[1024];
|
||||
int argi, i;
|
||||
int rc;
|
||||
|
||||
for (argi = 1; argi < argc; argi++) {
|
||||
/* --config */
|
||||
if (!strcmp(argv[argi], "--config")) {
|
||||
if (argi > 1) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "Given command line option '%s' must be the first option specified, use '-h' for help!\n", argv[argi]);
|
||||
return -EINVAL;
|
||||
}
|
||||
if (argc <= 2) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "Given command line option '%s' requires 1 parameter, use '-h' for help!\n", argv[argi]);
|
||||
return -EINVAL;
|
||||
}
|
||||
argi += 1;
|
||||
continue;
|
||||
}
|
||||
if (argv[argi][0] == '-') {
|
||||
if (argv[argi][1] != '-') {
|
||||
if (strlen(argv[argi]) != 2) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "Given command line option '%s' exceeds one character, use '-h' for help!\n", argv[argi]);
|
||||
return -EINVAL;
|
||||
}
|
||||
/* -x */
|
||||
for (option = option_head; option; option = option->next) {
|
||||
if (argv[argi][1] == option->short_option) {
|
||||
if (option->parameter_count && argi + option->parameter_count < argc) {
|
||||
params[0] = '\0';
|
||||
for (i = 0; i < option->parameter_count; i++)
|
||||
sprintf(strchr(params, '\0'), " '%s'", argv[argi + 1 + i]);
|
||||
PDEBUG(DOPTIONS, DEBUG_INFO, "Command line option '%s' ('--%s'), parameter%s\n", argv[argi], option->long_option, params);
|
||||
} else
|
||||
PDEBUG(DOPTIONS, DEBUG_INFO, "Command line option '%s' ('--%s')\n", argv[argi], option->long_option);
|
||||
break;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
/* --xxxxxx */
|
||||
for (option = option_head; option; option = option->next) {
|
||||
if (!strcmp(argv[argi] + 2, option->long_option)) {
|
||||
if (option->parameter_count && argi + option->parameter_count < argc) {
|
||||
params[0] = '\0';
|
||||
for (i = 0; i < option->parameter_count; i++)
|
||||
sprintf(strchr(params, '\0'), " '%s'", argv[argi + 1 + i]);
|
||||
PDEBUG(DOPTIONS, DEBUG_INFO, "Command line option '%s', parameter%s\n", argv[argi], params);
|
||||
} else
|
||||
PDEBUG(DOPTIONS, DEBUG_INFO, "Command line option '%s'\n", argv[argi]);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
if (!option) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "Given command line option '%s' is not a valid option, use '-h' for help!\n", argv[argi]);
|
||||
return -EINVAL;
|
||||
}
|
||||
if (argi + option->parameter_count >= argc) {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "Given command line option '%s' requires %d parameter(s), use '-h' for help!\n", argv[argi], option->parameter_count);
|
||||
return -EINVAL;
|
||||
}
|
||||
rc = handle_options(option->short_option, argi + 1, argv);
|
||||
if (rc <= 0)
|
||||
return rc;
|
||||
first_option = 0;
|
||||
argi += option->parameter_count;
|
||||
} else
|
||||
break;
|
||||
}
|
||||
|
||||
/* no more options, so we check if there is an option after a non-option parameter */
|
||||
for (i = argi; i < argc; i++) {
|
||||
if (argv[i][0] == '-') {
|
||||
PDEBUG(DOPTIONS, DEBUG_ERROR, "Given command line option '%s' behind command line parameter '%s' not allowed! Please put all command line options before command line parameter(s).\n", argv[i], argv[argi]);
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
return argi;
|
||||
}
|
||||
|
||||
int option_is_first(void)
|
||||
{
|
||||
return first_option;
|
||||
}
|
||||
|
||||
void options_free(void)
|
||||
{
|
||||
while (options_strdup_list) {
|
||||
struct options_strdup_entry *o;
|
||||
o = options_strdup_list;
|
||||
options_strdup_list = o->next;
|
||||
free(o);
|
||||
}
|
||||
|
||||
while (option_head) {
|
||||
option_t *o;
|
||||
o = option_head;
|
||||
option_head = o->next;
|
||||
free(o);
|
||||
}
|
||||
option_tailp = &option_head;
|
||||
}
|
||||
|
|
@ -1,8 +0,0 @@
|
|||
|
||||
char *options_strdup(const char *s);
|
||||
void option_add(int short_option, const char *long_option, int parameter_count);
|
||||
int options_config_file(int argc, char *argv[], const char *config_file, int (*handle_options)(int short_option, int argi, char *argv[]));
|
||||
int options_command_line(int argc, char *argv[], int (*handle_options)(int short_option, int argi, char *argv[]));
|
||||
int option_is_first(void);
|
||||
void options_free(void);
|
||||
|
|
@ -1,6 +0,0 @@
|
|||
AM_CPPFLAGS = -Wall -Wextra -g $(all_includes)
|
||||
|
||||
noinst_LIBRARIES = libsample.a
|
||||
|
||||
libsample_a_SOURCES = \
|
||||
sample.c
|
|
@ -1,64 +0,0 @@
|
|||
/* Sample definition
|
||||
*
|
||||
* (C) 2017 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdint.h>
|
||||
#include "sample.h"
|
||||
|
||||
/*
|
||||
* A regular voice conversation takes place at this factor below the full range
|
||||
* of 16 bits signed value:
|
||||
*/
|
||||
static double int_16_speech_level = SPEECH_LEVEL * 0.7079; /* 16 dBm below dBm0, which is about 3dBm below full 16 bit range */
|
||||
|
||||
/* A sample_t is a value that has virtually infinite precision but will also
|
||||
* support high numbers. 'double' or 'float' types are sufficient.
|
||||
*
|
||||
* When using sample_t inside signal processing of each base station, the
|
||||
* level of +- 1 is relative to the normal speech evenlope.
|
||||
*
|
||||
* When converting sample_t to int16_t, the level of +- 1 is reduced by factor.
|
||||
* This way the speech may be louder before clipping happens.
|
||||
*
|
||||
* When using sample_t to modulate (SDR or sound card), the level is changed,
|
||||
* so it represents the frequency deviation in Hz. The deviation of speech
|
||||
* envelope is network dependent.
|
||||
*/
|
||||
|
||||
void samples_to_int16(int16_t *spl, sample_t *samples, int length)
|
||||
{
|
||||
int32_t value;
|
||||
|
||||
while (length--) {
|
||||
value = *samples++ * int_16_speech_level * 32768.0;
|
||||
if (value > 32767.0)
|
||||
*spl++ = 32767;
|
||||
else if (value < -32767.0)
|
||||
*spl++ = -32767;
|
||||
else
|
||||
*spl++ = (uint16_t)value;
|
||||
}
|
||||
}
|
||||
|
||||
void int16_to_samples(sample_t *samples, int16_t *spl, int length)
|
||||
{
|
||||
while (length--) {
|
||||
*samples++ = (double)(*spl++) / 32767.0 / int_16_speech_level;
|
||||
}
|
||||
}
|
||||
|
|
@ -1,8 +0,0 @@
|
|||
|
||||
typedef double sample_t;
|
||||
|
||||
#define SPEECH_LEVEL 0.1585
|
||||
|
||||
void samples_to_int16(int16_t *spl, sample_t *samples, int length);
|
||||
void int16_to_samples(sample_t *samples, int16_t *spl, int length);
|
||||
|
|
@ -1,8 +0,0 @@
|
|||
AM_CPPFLAGS = -Wall -Wextra -g $(all_includes)
|
||||
|
||||
noinst_LIBRARIES = libsound.a
|
||||
|
||||
libsound_a_SOURCES = \
|
||||
sound_alsa.c
|
||||
|
||||
AM_CPPFLAGS += -DHAVE_ALSA
|
|
@ -1,10 +0,0 @@
|
|||
|
||||
enum paging_signal;
|
||||
|
||||
void *sound_open(const char *audiodev, double *tx_frequency, double *rx_frequency, int *am, int channels, double paging_frequency, int samplerate, int buffer_size, double interval, double max_deviation, double max_modulation, double modulation_index);
|
||||
int sound_start(void *inst);
|
||||
void sound_close(void *inst);
|
||||
int sound_write(void *inst, sample_t **samples, uint8_t **power, int num, enum paging_signal *paging_signal, int *on, int channels);
|
||||
int sound_read(void *inst, sample_t **samples, int num, int channels, double *rf_level_db);
|
||||
int sound_get_tosend(void *inst, int buffer_size);
|
||||
|
|
@ -1,535 +0,0 @@
|
|||
/* Sound device access
|
||||
*
|
||||
* (C) 2016 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <stdint.h>
|
||||
#include <math.h>
|
||||
#include <alsa/asoundlib.h>
|
||||
#include "../libsample/sample.h"
|
||||
#include "../libdebug/debug.h"
|
||||
#ifdef HAVE_MOBILE
|
||||
#include "../libmobile/sender.h"
|
||||
#else
|
||||
#include "sound.h"
|
||||
#endif
|
||||
|
||||
typedef struct sound {
|
||||
snd_pcm_t *phandle, *chandle;
|
||||
int pchannels, cchannels;
|
||||
int channels; /* required number of channels */
|
||||
int samplerate; /* required sample rate */
|
||||
char *audiodev; /* required device */
|
||||
double spl_deviation; /* how much deviation is one sample step */
|
||||
#ifdef HAVE_MOBILE
|
||||
double paging_phaseshift; /* phase to shift every sample */
|
||||
double paging_phase; /* current phase */
|
||||
double rx_frequency[2]; /* rx frequency of radio connected to channel */
|
||||
dispmeasparam_t *dmp[2];
|
||||
#endif
|
||||
} sound_t;
|
||||
|
||||
static int set_hw_params(snd_pcm_t *handle, int samplerate, int *channels)
|
||||
{
|
||||
snd_pcm_hw_params_t *hw_params = NULL;
|
||||
int rc;
|
||||
unsigned int rrate;
|
||||
|
||||
rc = snd_pcm_hw_params_malloc(&hw_params);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Failed to allocate hw_params! (%s)\n", snd_strerror(rc));
|
||||
goto error;
|
||||
}
|
||||
|
||||
rc = snd_pcm_hw_params_any(handle, hw_params);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "cannot initialize hardware parameter structure (%s)\n", snd_strerror(rc));
|
||||
goto error;
|
||||
}
|
||||
|
||||
rc = snd_pcm_hw_params_set_rate_resample(handle, hw_params, 0);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "cannot set real hardware rate (%s)\n", snd_strerror(rc));
|
||||
goto error;
|
||||
}
|
||||
|
||||
rc = snd_pcm_hw_params_set_access (handle, hw_params, SND_PCM_ACCESS_RW_INTERLEAVED);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "cannot set access to interleaved (%s)\n", snd_strerror(rc));
|
||||
goto error;
|
||||
}
|
||||
|
||||
rc = snd_pcm_hw_params_set_format(handle, hw_params, SND_PCM_FORMAT_S16);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "cannot set sample format (%s)\n", snd_strerror(rc));
|
||||
goto error;
|
||||
}
|
||||
|
||||
rrate = samplerate;
|
||||
rc = snd_pcm_hw_params_set_rate_near(handle, hw_params, &rrate, 0);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "cannot set sample rate (%s)\n", snd_strerror(rc));
|
||||
goto error;
|
||||
}
|
||||
if ((int)rrate != samplerate) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Rate doesn't match (requested %dHz, get %dHz)\n", samplerate, rrate);
|
||||
rc = -EIO;
|
||||
goto error;
|
||||
}
|
||||
|
||||
*channels = 1;
|
||||
rc = snd_pcm_hw_params_set_channels(handle, hw_params, *channels);
|
||||
if (rc < 0) {
|
||||
*channels = 2;
|
||||
rc = snd_pcm_hw_params_set_channels(handle, hw_params, *channels);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "cannot set channel count to 1 nor 2 (%s)\n", snd_strerror(rc));
|
||||
goto error;
|
||||
}
|
||||
}
|
||||
|
||||
rc = snd_pcm_hw_params(handle, hw_params);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "cannot set parameters (%s)\n", snd_strerror(rc));
|
||||
goto error;
|
||||
}
|
||||
|
||||
snd_pcm_hw_params_free(hw_params);
|
||||
|
||||
return 0;
|
||||
|
||||
error:
|
||||
if (hw_params) {
|
||||
snd_pcm_hw_params_free(hw_params);
|
||||
}
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
static int dev_open(sound_t *sound)
|
||||
{
|
||||
int rc, rc_rec, rc_play;
|
||||
|
||||
rc_play = snd_pcm_open(&sound->phandle, sound->audiodev, SND_PCM_STREAM_PLAYBACK, SND_PCM_NONBLOCK);
|
||||
rc_rec = snd_pcm_open(&sound->chandle, sound->audiodev, SND_PCM_STREAM_CAPTURE, SND_PCM_NONBLOCK);
|
||||
if (rc_play < 0 && rc_rec < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Failed to open '%s'! (%s)\n", sound->audiodev, snd_strerror(rc_play));
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Run 'aplay -l' to get a list of available cards and devices.\n");
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Then use 'hw:<card>:<device>' for audio device.\n");
|
||||
return rc_play;
|
||||
}
|
||||
if (rc_play < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Failed to open '%s' for playback! (%s) Please select a device that supports both direction audio.\n", sound->audiodev, snd_strerror(rc_play));
|
||||
return rc_play;
|
||||
}
|
||||
if (rc_rec < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Failed to open '%s' for capture! (%s) Please select a device that supports both direction audio.\n", sound->audiodev, snd_strerror(rc_rec));
|
||||
return rc_rec;
|
||||
}
|
||||
|
||||
rc = set_hw_params(sound->phandle, sound->samplerate, &sound->pchannels);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Failed to set playback hw params\n");
|
||||
return rc;
|
||||
}
|
||||
if (sound->pchannels < sound->channels) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Sound card only supports %d channel for playback.\n", sound->pchannels);
|
||||
return rc;
|
||||
}
|
||||
PDEBUG(DSOUND, DEBUG_DEBUG, "Playback with %d channels.\n", sound->pchannels);
|
||||
|
||||
rc = set_hw_params(sound->chandle, sound->samplerate, &sound->cchannels);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Failed to set capture hw params\n");
|
||||
return rc;
|
||||
}
|
||||
if (sound->cchannels < sound->channels) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Sound card only supports %d channel for capture.\n", sound->cchannels);
|
||||
return -EIO;
|
||||
}
|
||||
PDEBUG(DSOUND, DEBUG_DEBUG, "Capture with %d channels.\n", sound->cchannels);
|
||||
|
||||
rc = snd_pcm_prepare(sound->phandle);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "cannot prepare audio interface for use (%s)\n", snd_strerror(rc));
|
||||
return rc;
|
||||
}
|
||||
|
||||
rc = snd_pcm_prepare(sound->chandle);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "cannot prepare audio interface for use (%s)\n", snd_strerror(rc));
|
||||
return rc;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void dev_close(sound_t *sound)
|
||||
{
|
||||
if (sound->phandle != NULL)
|
||||
snd_pcm_close(sound->phandle);
|
||||
if (sound->chandle != NULL)
|
||||
snd_pcm_close(sound->chandle);
|
||||
}
|
||||
|
||||
void *sound_open(const char *audiodev, double __attribute__((unused)) *tx_frequency, double __attribute__((unused)) *rx_frequency, int __attribute__((unused)) *am, int channels, double __attribute__((unused)) paging_frequency, int samplerate, int __attribute((unused)) buffer_size, double __attribute__((unused)) interval, double max_deviation, double __attribute__((unused)) max_modulation, double __attribute__((unused)) modulation_index)
|
||||
{
|
||||
sound_t *sound;
|
||||
int rc;
|
||||
|
||||
if (channels < 1 || channels > 2) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Cannot use more than two channels with the same sound card!\n");
|
||||
return NULL;
|
||||
}
|
||||
|
||||
sound = calloc(1, sizeof(sound_t));
|
||||
if (!sound) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Failed to alloc memory!\n");
|
||||
return NULL;
|
||||
}
|
||||
|
||||
sound->audiodev = strdup(audiodev); // is feed when closed
|
||||
sound->channels = channels;
|
||||
sound->samplerate = samplerate;
|
||||
sound->spl_deviation = max_deviation / 32767.0;
|
||||
#ifdef HAVE_MOBILE
|
||||
sound->paging_phaseshift = 1.0 / ((double)samplerate / 1000.0);
|
||||
#endif
|
||||
|
||||
rc = dev_open(sound);
|
||||
if (rc < 0)
|
||||
goto error;
|
||||
|
||||
#ifdef HAVE_MOBILE
|
||||
if (rx_frequency) {
|
||||
sender_t *sender;
|
||||
int i;
|
||||
for (i = 0; i < channels; i++) {
|
||||
sound->rx_frequency[i] = rx_frequency[i];
|
||||
sender = get_sender_by_empfangsfrequenz(sound->rx_frequency[i]);
|
||||
if (!sender)
|
||||
continue;
|
||||
sound->dmp[i] = display_measurements_add(&sender->dispmeas, "RX Level", "%.1f dB", DISPLAY_MEAS_PEAK, DISPLAY_MEAS_LEFT, -96.0, 0.0, -INFINITY);
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
return sound;
|
||||
|
||||
error:
|
||||
sound_close(sound);
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* start streaming */
|
||||
int sound_start(void *inst)
|
||||
{
|
||||
sound_t *sound = (sound_t *)inst;
|
||||
int16_t buff[2];
|
||||
|
||||
/* trigger capturing */
|
||||
snd_pcm_readi(sound->chandle, buff, 1);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void sound_close(void *inst)
|
||||
{
|
||||
sound_t *sound = (sound_t *)inst;
|
||||
|
||||
dev_close(sound);
|
||||
free(sound->audiodev);
|
||||
free(sound);
|
||||
}
|
||||
|
||||
#ifdef HAVE_MOBILE
|
||||
static void gen_paging_tone(sound_t *sound, int16_t *samples, int length, enum paging_signal paging_signal, int on)
|
||||
{
|
||||
double phaseshift, phase;
|
||||
int i;
|
||||
|
||||
switch (paging_signal) {
|
||||
case PAGING_SIGNAL_NOTONE:
|
||||
/* no tone if paging signal is on */
|
||||
on = !on;
|
||||
/* FALLTHRU */
|
||||
case PAGING_SIGNAL_TONE:
|
||||
/* tone if paging signal is on */
|
||||
if (on) {
|
||||
phaseshift = sound->paging_phaseshift;
|
||||
phase = sound->paging_phase;
|
||||
for (i = 0; i < length; i++) {
|
||||
if (phase < 0.5)
|
||||
*samples++ = 30000;
|
||||
else
|
||||
*samples++ = -30000;
|
||||
phase += phaseshift;
|
||||
if (phase >= 1.0)
|
||||
phase -= 1.0;
|
||||
}
|
||||
sound->paging_phase = phase;
|
||||
} else
|
||||
memset(samples, 0, length << 1);
|
||||
break;
|
||||
case PAGING_SIGNAL_NEGATIVE:
|
||||
/* negative signal if paging signal is on */
|
||||
on = !on;
|
||||
/* FALLTHRU */
|
||||
case PAGING_SIGNAL_POSITIVE:
|
||||
/* positive signal if paging signal is on */
|
||||
if (on)
|
||||
memset(samples, 127, length << 1);
|
||||
else
|
||||
memset(samples, 128, length << 1);
|
||||
break;
|
||||
case PAGING_SIGNAL_NONE:
|
||||
break;
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
int sound_write(void *inst, sample_t **samples, uint8_t __attribute__((unused)) **power, int num, enum paging_signal __attribute__((unused)) *paging_signal, int __attribute__((unused)) *on, int channels)
|
||||
{
|
||||
sound_t *sound = (sound_t *)inst;
|
||||
double spl_deviation = sound->spl_deviation;
|
||||
int32_t value;
|
||||
int16_t buff[num << 1];
|
||||
int rc;
|
||||
int i, ii;
|
||||
|
||||
if (sound->pchannels == 2) {
|
||||
/* two channels */
|
||||
#ifdef HAVE_MOBILE
|
||||
if (paging_signal && on && paging_signal[0] != PAGING_SIGNAL_NONE) {
|
||||
int16_t paging[num << 1];
|
||||
gen_paging_tone(sound, paging, num, paging_signal[0], on[0]);
|
||||
for (i = 0, ii = 0; i < num; i++) {
|
||||
value = samples[0][i] / spl_deviation;
|
||||
if (value > 32767)
|
||||
value = 32767;
|
||||
else if (value < -32767)
|
||||
value = -32767;
|
||||
buff[ii++] = value;
|
||||
buff[ii++] = paging[i];
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
if (channels == 2) {
|
||||
for (i = 0, ii = 0; i < num; i++) {
|
||||
value = samples[0][i] / spl_deviation;
|
||||
if (value > 32767)
|
||||
value = 32767;
|
||||
else if (value < -32767)
|
||||
value = -32767;
|
||||
buff[ii++] = value;
|
||||
value = samples[1][i] / spl_deviation;
|
||||
if (value > 32767)
|
||||
value = 32767;
|
||||
else if (value < -32767)
|
||||
value = -32767;
|
||||
buff[ii++] = value;
|
||||
}
|
||||
} else {
|
||||
for (i = 0, ii = 0; i < num; i++) {
|
||||
value = samples[0][i] / spl_deviation;
|
||||
if (value > 32767)
|
||||
value = 32767;
|
||||
else if (value < -32767)
|
||||
value = -32767;
|
||||
buff[ii++] = value;
|
||||
buff[ii++] = value;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
/* one channel */
|
||||
for (i = 0, ii = 0; i < num; i++) {
|
||||
value = samples[0][i] / spl_deviation;
|
||||
if (value > 32767)
|
||||
value = 32767;
|
||||
else if (value < -32767)
|
||||
value = -32767;
|
||||
buff[ii++] = value;
|
||||
}
|
||||
}
|
||||
rc = snd_pcm_writei(sound->phandle, buff, num);
|
||||
|
||||
if (rc < 0) {
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "failed to write audio to interface (%s)\n", snd_strerror(rc));
|
||||
if (rc == -EPIPE) {
|
||||
dev_close(sound);
|
||||
rc = dev_open(sound);
|
||||
if (rc < 0)
|
||||
return rc;
|
||||
sound_start(sound);
|
||||
return -EPIPE; /* indicate what happened */
|
||||
}
|
||||
return rc;
|
||||
}
|
||||
|
||||
if (rc != num)
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "short write to audio interface, written %d bytes, got %d bytes\n", num, rc);
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
#define KEEP_FRAMES 8 /* minimum frames not to read, due to bug in ALSA */
|
||||
|
||||
int sound_read(void *inst, sample_t **samples, int num, int channels, double __attribute__((unused)) *rf_level_db)
|
||||
{
|
||||
sound_t *sound = (sound_t *)inst;
|
||||
double spl_deviation = sound->spl_deviation;
|
||||
int16_t buff[num << 1];
|
||||
int32_t spl;
|
||||
int32_t max[2], a;
|
||||
int in, rc;
|
||||
int i, ii;
|
||||
|
||||
/* make valgrind happy, because snd_pcm_readi() does not seem to initially fill buffer with values */
|
||||
memset(buff, 0, sizeof(buff));
|
||||
|
||||
/* get samples in rx buffer */
|
||||
in = snd_pcm_avail(sound->chandle);
|
||||
/* if not more than KEEP_FRAMES frames available, try next time */
|
||||
if (in <= KEEP_FRAMES)
|
||||
return 0;
|
||||
/* read some frames less than in buffer, because snd_pcm_readi() seems
|
||||
* to corrupt last frames */
|
||||
in -= KEEP_FRAMES;
|
||||
if (in > num)
|
||||
in = num;
|
||||
|
||||
rc = snd_pcm_readi(sound->chandle, buff, in);
|
||||
|
||||
if (rc < 0) {
|
||||
if (errno == EAGAIN)
|
||||
return 0;
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "failed to read audio from interface (%s)\n", snd_strerror(rc));
|
||||
/* recover read */
|
||||
if (rc == -EPIPE) {
|
||||
dev_close(sound);
|
||||
rc = dev_open(sound);
|
||||
if (rc < 0)
|
||||
return rc;
|
||||
sound_start(sound);
|
||||
return -EPIPE; /* indicate what happened */
|
||||
}
|
||||
return rc;
|
||||
}
|
||||
|
||||
if (rc == 0)
|
||||
return rc;
|
||||
|
||||
if (sound->cchannels == 2) {
|
||||
if (channels < 2) {
|
||||
for (i = 0, ii = 0; i < rc; i++) {
|
||||
spl = buff[ii++];
|
||||
spl += buff[ii++];
|
||||
a = (spl >= 0) ? spl : -spl;
|
||||
if (i == 0 || a > max[0])
|
||||
max[0] = a;
|
||||
samples[0][i] = (double)spl * spl_deviation;
|
||||
}
|
||||
} else {
|
||||
for (i = 0, ii = 0; i < rc; i++) {
|
||||
spl = buff[ii++];
|
||||
a = (spl >= 0) ? spl : -spl;
|
||||
if (i == 0 || a > max[0])
|
||||
max[0] = a;
|
||||
samples[0][i] = (double)spl * spl_deviation;
|
||||
spl = buff[ii++];
|
||||
a = (spl >= 0) ? spl : -spl;
|
||||
if (i == 0 || a > max[1])
|
||||
max[1] = a;
|
||||
samples[1][i] = (double)spl * spl_deviation;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
for (i = 0, ii = 0; i < rc; i++) {
|
||||
spl = buff[ii++];
|
||||
a = (spl >= 0) ? spl : -spl;
|
||||
if (i == 0 || a > max[0])
|
||||
max[0] = a;
|
||||
samples[0][i] = (double)spl * spl_deviation;
|
||||
}
|
||||
}
|
||||
|
||||
#ifdef HAVE_MOBILE
|
||||
sender_t *sender;
|
||||
for (i = 0; i < channels; i++) {
|
||||
sender = get_sender_by_empfangsfrequenz(sound->rx_frequency[i]);
|
||||
if (!sender)
|
||||
continue;
|
||||
display_measurements_update(sound->dmp[i], log10((double)max[i] / 32768.0) * 20, 0.0);
|
||||
if (rf_level_db)
|
||||
rf_level_db[i] = 0.0;
|
||||
}
|
||||
#endif
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
/*
|
||||
* get playback buffer space
|
||||
*
|
||||
* return number of samples to be sent */
|
||||
int sound_get_tosend(void *inst, int buffer_size)
|
||||
{
|
||||
sound_t *sound = (sound_t *)inst;
|
||||
int rc;
|
||||
snd_pcm_sframes_t delay;
|
||||
int tosend;
|
||||
|
||||
rc = snd_pcm_delay(sound->phandle, &delay);
|
||||
if (rc < 0) {
|
||||
if (rc == -32)
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "Buffer underrun: Please use higher buffer and enable real time scheduling\n");
|
||||
else
|
||||
PDEBUG(DSOUND, DEBUG_ERROR, "failed to get delay from interface (%s)\n", snd_strerror(rc));
|
||||
if (rc == -EPIPE) {
|
||||
dev_close(sound);
|
||||
rc = dev_open(sound);
|
||||
if (rc < 0)
|
||||
return rc;
|
||||
sound_start(sound);
|
||||
return -EPIPE; /* indicate what happened */
|
||||
}
|
||||
return rc;
|
||||
}
|
||||
|
||||
tosend = buffer_size - delay;
|
||||
return tosend;
|
||||
}
|
||||
|
||||
int sound_is_stereo_capture(void *inst)
|
||||
{
|
||||
sound_t *sound = (sound_t *)inst;
|
||||
|
||||
if (sound->cchannels == 2)
|
||||
return 1;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int sound_is_stereo_playback(void *inst)
|
||||
{
|
||||
sound_t *sound = (sound_t *)inst;
|
||||
|
||||
if (sound->pchannels == 2)
|
||||
return 1;
|
||||
return 0;
|
||||
}
|
||||
|
|
@ -1,6 +0,0 @@
|
|||
AM_CPPFLAGS = -Wall -Wextra -g $(all_includes)
|
||||
|
||||
noinst_LIBRARIES = libwave.a
|
||||
|
||||
libwave_a_SOURCES = \
|
||||
wave.c
|
|
@ -1,519 +0,0 @@
|
|||
/* wave recording and playback functions
|
||||
*
|
||||
* (C) 2016 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <errno.h>
|
||||
#include <unistd.h>
|
||||
#include <pthread.h>
|
||||
#include "../libsample/sample.h"
|
||||
#include "../libdebug/debug.h"
|
||||
#include "wave.h"
|
||||
|
||||
/* NOTE: No locking required for writing and reading buffer pointers, since 'int' is atomic on >=32 bit machines */
|
||||
|
||||
static void *record_child(void *arg)
|
||||
{
|
||||
wave_rec_t *rec = (wave_rec_t *)arg;
|
||||
int to_write, to_end, len;
|
||||
|
||||
while (!rec->finish || rec->buffer_writep != rec->buffer_readp) {
|
||||
/* how much data is in buffer */
|
||||
to_write = (rec->buffer_size + rec->buffer_writep - rec->buffer_readp) % rec->buffer_size;
|
||||
if (to_write == 0) {
|
||||
usleep(10000);
|
||||
continue;
|
||||
}
|
||||
/* only write up to the end of buffer */
|
||||
to_end = rec->buffer_size - rec->buffer_readp;
|
||||
if (to_end < to_write)
|
||||
to_write = to_end;
|
||||
/* write */
|
||||
errno = 0;
|
||||
len = fwrite(rec->buffer + rec->buffer_readp, 1, to_write, rec->fp);
|
||||
/* quit on error */
|
||||
if (len < 0) {
|
||||
error:
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Failed to write to recording WAVE file! (errno %d)\n", errno);
|
||||
rec->finish = 1;
|
||||
return NULL;
|
||||
}
|
||||
/* increment read pointer */
|
||||
rec->buffer_readp += len;
|
||||
if (rec->buffer_readp == rec->buffer_size)
|
||||
rec->buffer_readp = 0;
|
||||
/* quit on end of file */
|
||||
if (len != to_write)
|
||||
goto error;
|
||||
}
|
||||
|
||||
return NULL;
|
||||
}
|
||||
|
||||
static void *playback_child(void *arg)
|
||||
{
|
||||
wave_play_t *play = (wave_play_t *)arg;
|
||||
int to_read, to_end, len;
|
||||
|
||||
while(!play->finish) {
|
||||
/* how much space is in buffer */
|
||||
to_read = (play->buffer_size + play->buffer_readp - play->buffer_writep - 1) % play->buffer_size;
|
||||
if (to_read == 0) {
|
||||
usleep(10000);
|
||||
continue;
|
||||
}
|
||||
/* only read up to the end of buffer */
|
||||
to_end = play->buffer_size - play->buffer_writep;
|
||||
if (to_end < to_read)
|
||||
to_read = to_end;
|
||||
/* read */
|
||||
len = fread(play->buffer + play->buffer_writep, 1, to_read, play->fp);
|
||||
/* quit on error */
|
||||
if (len < 0) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Failed to read from playback WAVE file! (errno %d)\n", errno);
|
||||
play->finish = 1;
|
||||
return NULL;
|
||||
}
|
||||
/* increment write pointer */
|
||||
play->buffer_writep += len;
|
||||
if (play->buffer_writep == play->buffer_size)
|
||||
play->buffer_writep = 0;
|
||||
/* quit on end of file */
|
||||
if (len != to_read) {
|
||||
play->finish = 1;
|
||||
return NULL;
|
||||
}
|
||||
}
|
||||
|
||||
return NULL;
|
||||
}
|
||||
|
||||
struct fmt {
|
||||
uint16_t format; /* 1 = pcm, 2 = adpcm */
|
||||
uint16_t channels; /* number of channels */
|
||||
uint32_t sample_rate; /* sample rate */
|
||||
uint32_t data_rate; /* data rate */
|
||||
uint16_t bytes_sample; /* bytes per sample (all channels) */
|
||||
uint16_t bits_sample; /* bits per sample (one channel) */
|
||||
};
|
||||
|
||||
int wave_create_record(wave_rec_t *rec, const char *filename, int samplerate, int channels, double max_deviation)
|
||||
{
|
||||
/* RIFFxxxxWAVEfmt xxxx(fmt size)dataxxxx... */
|
||||
char dummyheader[4 + 4 + 4 + 4 + 4 + sizeof(struct fmt) + 4 + 4];
|
||||
int __attribute__((__unused__)) len;
|
||||
int rc;
|
||||
|
||||
memset(rec, 0, sizeof(*rec));
|
||||
rec->samplerate = samplerate;
|
||||
rec->channels = channels;
|
||||
rec->max_deviation = max_deviation;
|
||||
|
||||
rec->fp = fopen(filename, "w");
|
||||
if (!rec->fp) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Failed to open recording file '%s'! (errno %d)\n", filename, errno);
|
||||
return -errno;
|
||||
}
|
||||
|
||||
memset(&dummyheader, 0, sizeof(dummyheader));
|
||||
len = fwrite(dummyheader, 1, sizeof(dummyheader), rec->fp);
|
||||
|
||||
rec->buffer_size = samplerate * 2 * channels;
|
||||
rec->buffer = calloc(rec->buffer_size, 1);
|
||||
if (!rec->buffer) {
|
||||
PDEBUG(DWAVE, DEBUG_NOTICE, "No mem!\n");
|
||||
rc = ENOMEM;
|
||||
goto error;
|
||||
}
|
||||
|
||||
rc = pthread_create(&rec->tid, NULL, record_child, rec);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Failed to create thread to record WAVE file! (errno %d)\n", errno);
|
||||
goto error;
|
||||
}
|
||||
|
||||
PDEBUG(DWAVE, DEBUG_NOTICE, "*** Writing WAVE file to %s.\n", filename);
|
||||
|
||||
return 0;
|
||||
|
||||
error:
|
||||
if (rec->buffer) {
|
||||
free(rec->buffer);
|
||||
rec->buffer = NULL;
|
||||
}
|
||||
if (rec->fp) {
|
||||
fclose(rec->fp);
|
||||
rec->fp = NULL;
|
||||
}
|
||||
return rc;
|
||||
}
|
||||
|
||||
int wave_create_playback(wave_play_t *play, const char *filename, int *samplerate_p, int *channels_p, double max_deviation)
|
||||
{
|
||||
uint8_t buffer[256];
|
||||
struct fmt fmt;
|
||||
int32_t size, chunk, len;
|
||||
int gotfmt = 0, gotdata = 0;
|
||||
int rc = -EINVAL;
|
||||
|
||||
memset(&fmt, 0, sizeof(fmt));
|
||||
memset(play, 0, sizeof(*play));
|
||||
play->max_deviation = max_deviation;
|
||||
|
||||
play->fp = fopen(filename, "r");
|
||||
if (!play->fp) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Failed to open playback file '%s'! (errno %d)\n", filename, errno);
|
||||
return -errno;
|
||||
}
|
||||
|
||||
len = fread(buffer, 1, 12, play->fp);
|
||||
if (len != 12) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Failed to read RIFF header!\n");
|
||||
rc = -EIO;
|
||||
goto error;
|
||||
}
|
||||
if (!!strncmp((char *)buffer, "RIFF", 4)) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Missing RIFF header, seems that this is no WAVE file!\n");
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
size = buffer[4] + (buffer[5] << 8) + (buffer[6] << 16) + (buffer[7] << 24);
|
||||
if (!!strncmp((char *)buffer + 8, "WAVE", 4)) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Missing WAVE header, seems that this is no WAVE file!\n");
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
size -= 4;
|
||||
while (size) {
|
||||
if (size < 8) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Short read of WAVE file!\n");
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
len = fread(buffer, 1, 8, play->fp);
|
||||
if (len != 8) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Failed to read chunk of WAVE file!\n");
|
||||
rc = -EIO;
|
||||
goto error;
|
||||
}
|
||||
chunk = buffer[4] + (buffer[5] << 8) + (buffer[6] << 16) + (buffer[7] << 24);
|
||||
size -= 8 + chunk;
|
||||
if (size < 0) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "WAVE error: Chunk '%c%c%c%c' overflows file size!\n", buffer[4], buffer[5], buffer[6], buffer[7]);
|
||||
rc = -EIO;
|
||||
goto error;
|
||||
}
|
||||
if (!strncmp((char *)buffer, "fmt ", 4)) {
|
||||
if (chunk < 16 || chunk > (int)sizeof(buffer)) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "WAVE error: Short or corrupt 'fmt' chunk!\n");
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
len = fread(buffer, 1, chunk, play->fp);
|
||||
fmt.format = buffer[0] + (buffer[1] << 8);
|
||||
fmt.channels = buffer[2] + (buffer[3] << 8);
|
||||
fmt.sample_rate = buffer[4] + (buffer[5] << 8) + (buffer[6] << 16) + (buffer[7] << 24);
|
||||
fmt.data_rate = buffer[8] + (buffer[9] << 8) + (buffer[10] << 16) + (buffer[11] << 24);
|
||||
fmt.bytes_sample = buffer[12] + (buffer[13] << 8);
|
||||
fmt.bits_sample = buffer[14] + (buffer[15] << 8);
|
||||
gotfmt = 1;
|
||||
} else
|
||||
if (!strncmp((char *)buffer, "data", 4)) {
|
||||
if (!gotfmt) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "WAVE error: 'data' without 'fmt' chunk!\n");
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
gotdata = 1;
|
||||
break;
|
||||
} else {
|
||||
while(chunk > (int)sizeof(buffer)) {
|
||||
len = fread(buffer, 1, sizeof(buffer), play->fp);
|
||||
chunk -= sizeof(buffer);
|
||||
}
|
||||
if (chunk)
|
||||
len = fread(buffer, 1, chunk, play->fp);
|
||||
}
|
||||
}
|
||||
|
||||
if (!gotfmt || !gotdata) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "WAVE error: Missing 'data' or 'fmt' chunk!\n");
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
|
||||
if (fmt.format != 1) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "WAVE error: We support only PCM files!\n");
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
if (*channels_p == 0)
|
||||
*channels_p = fmt.channels;
|
||||
if (fmt.channels != *channels_p) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "WAVE error: We expect %d cannel(s), but wave file only has %d channel(s)\n", *channels_p, fmt.channels);
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
if (*samplerate_p == 0)
|
||||
*samplerate_p = fmt.sample_rate;
|
||||
if ((int)fmt.sample_rate != *samplerate_p) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "WAVE error: The WAVE file's sample rate (%d) does not match our sample rate (%d)!\n", fmt.sample_rate, *samplerate_p);
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
if ((int)fmt.data_rate != 2 * *channels_p * *samplerate_p) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "WAVE error: The WAVE file's data rate is only %d bytes per second, but we expect %d bytes per second (2 bytes per sample * channels * samplerate)!\n", fmt.data_rate, 2 * *channels_p * *samplerate_p);
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
if (fmt.bytes_sample != 2 * *channels_p) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "WAVE error: The WAVE file's bytes per sample is only %d, but we expect %d bytes sample (2 bytes per sample * channels)!\n", fmt.bytes_sample, 2 * *channels_p);
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
if (fmt.bits_sample != 16) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "WAVE error: We support only 16 bit files!\n");
|
||||
rc = -EINVAL;
|
||||
goto error;
|
||||
}
|
||||
|
||||
play->channels = *channels_p;
|
||||
play->left = chunk / 2 / *channels_p;
|
||||
|
||||
play->buffer_size = *samplerate_p * 2 * *channels_p;
|
||||
play->buffer = calloc(play->buffer_size, 1);
|
||||
if (!play->buffer) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "No mem!\n");
|
||||
rc = -ENOMEM;
|
||||
goto error;
|
||||
}
|
||||
|
||||
rc = pthread_create(&play->tid, NULL, playback_child, play);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DWAVE, DEBUG_ERROR, "Failed to create thread to playback WAVE file! (errno %d)\n", errno);
|
||||
goto error;
|
||||
}
|
||||
|
||||
PDEBUG(DWAVE, DEBUG_NOTICE, "*** Reading WAVE file from %s.\n", filename);
|
||||
|
||||
return 0;
|
||||
|
||||
error:
|
||||
if (play->buffer) {
|
||||
free(play->buffer);
|
||||
play->buffer = NULL;
|
||||
}
|
||||
if (play->fp) {
|
||||
fclose(play->fp);
|
||||
play->fp = NULL;
|
||||
}
|
||||
return rc;
|
||||
}
|
||||
|
||||
int wave_write(wave_rec_t *rec, sample_t **samples, int length)
|
||||
{
|
||||
double max_deviation = rec->max_deviation;
|
||||
int32_t value;
|
||||
int __attribute__((__unused__)) len;
|
||||
int i, c;
|
||||
int to_write;
|
||||
|
||||
/* on error, don't write more */
|
||||
if (rec->finish)
|
||||
return 0;
|
||||
|
||||
/* how much space is in buffer */
|
||||
to_write = (rec->buffer_size + rec->buffer_readp - rec->buffer_writep - 1) % rec->buffer_size;
|
||||
to_write /= 2 * rec->channels;
|
||||
if (to_write < length)
|
||||
PDEBUG(DWAVE, DEBUG_NOTICE, "Record WAVE buffer overflow.\n");
|
||||
else
|
||||
to_write = length;
|
||||
if (to_write == 0)
|
||||
return 0;
|
||||
|
||||
for (i = 0; i < to_write; i++) {
|
||||
for (c = 0; c < rec->channels; c++) {
|
||||
value = samples[c][i] / max_deviation * 32767.0;
|
||||
if (value > 32767)
|
||||
value = 32767;
|
||||
else if (value < -32767)
|
||||
value = -32767;
|
||||
rec->buffer[rec->buffer_writep] = value;
|
||||
rec->buffer_writep = (rec->buffer_writep + 1) % rec->buffer_size;
|
||||
rec->buffer[rec->buffer_writep] = value >> 8;
|
||||
rec->buffer_writep = (rec->buffer_writep + 1) % rec->buffer_size;
|
||||
}
|
||||
}
|
||||
rec->written += to_write;
|
||||
|
||||
return to_write;
|
||||
}
|
||||
|
||||
int wave_read(wave_play_t *play, sample_t **samples, int length)
|
||||
{
|
||||
double max_deviation = play->max_deviation;
|
||||
int16_t value; /* must be int16, so assembling bytes work */
|
||||
int __attribute__((__unused__)) len;
|
||||
int i, c;
|
||||
int to_read;
|
||||
int got = 0;
|
||||
|
||||
/* we have finished */
|
||||
if (play->left == 0) {
|
||||
to_read = 0;
|
||||
read_empty:
|
||||
for (i = to_read; i < length; i++) {
|
||||
for (c = 0; c < play->channels; c++)
|
||||
samples[c][i] = 0;
|
||||
}
|
||||
return got;
|
||||
}
|
||||
|
||||
/* how much do we read from buffer */
|
||||
to_read = (play->buffer_size + play->buffer_writep - play->buffer_readp) % play->buffer_size;
|
||||
to_read /= 2 * play->channels;
|
||||
if (to_read > (int)play->left)
|
||||
to_read = play->left;
|
||||
if (to_read > length)
|
||||
to_read = length;
|
||||
|
||||
if (to_read == 0 && play->finish) {
|
||||
if (play->left) {
|
||||
PDEBUG(DWAVE, DEBUG_NOTICE, "*** Finished reading WAVE file. (short read)\n");
|
||||
play->left = 0;
|
||||
}
|
||||
goto read_empty;
|
||||
}
|
||||
|
||||
/* read from buffer */
|
||||
for (i = 0; i < to_read; i++) {
|
||||
for (c = 0; c < play->channels; c++) {
|
||||
value = play->buffer[play->buffer_readp];
|
||||
play->buffer_readp = (play->buffer_readp + 1) % play->buffer_size;
|
||||
value |= play->buffer[play->buffer_readp] << 8;
|
||||
play->buffer_readp = (play->buffer_readp + 1) % play->buffer_size;
|
||||
samples[c][i] = (double)value / 32767.0 * max_deviation;
|
||||
}
|
||||
}
|
||||
got += to_read;
|
||||
play->left -= to_read;
|
||||
|
||||
if (!play->left)
|
||||
PDEBUG(DWAVE, DEBUG_NOTICE, "*** Finished reading WAVE file.\n");
|
||||
|
||||
if (to_read < length)
|
||||
goto read_empty;
|
||||
|
||||
return got;
|
||||
}
|
||||
|
||||
void wave_destroy_record(wave_rec_t *rec)
|
||||
{
|
||||
uint8_t buffer[256];
|
||||
uint32_t size, wsize;
|
||||
struct fmt fmt;
|
||||
int __attribute__((__unused__)) len;
|
||||
|
||||
if (!rec->fp)
|
||||
return;
|
||||
|
||||
/* on error, thread has terminated */
|
||||
if (rec->finish) {
|
||||
fclose(rec->fp);
|
||||
rec->fp = NULL;
|
||||
return;
|
||||
}
|
||||
|
||||
/* finish thread */
|
||||
rec->finish = 1;
|
||||
pthread_join(rec->tid, NULL);
|
||||
|
||||
/* cue */
|
||||
fprintf(rec->fp, "cue %c%c%c%c%c%c%c%c", 4, 0, 0, 0, 0,0,0,0);
|
||||
|
||||
/* LIST */
|
||||
fprintf(rec->fp, "LIST%c%c%c%cadtl", 4, 0, 0, 0);
|
||||
|
||||
/* go to header */
|
||||
fseek(rec->fp, 0, SEEK_SET);
|
||||
|
||||
size = 2 * rec->written * rec->channels;
|
||||
wsize = 4 + 8 + sizeof(fmt) + 8 + size + 8 + 4 + 8 + 4;
|
||||
|
||||
/* RIFF */
|
||||
fprintf(rec->fp, "RIFF%c%c%c%c", wsize & 0xff, (wsize >> 8) & 0xff, (wsize >> 16) & 0xff, wsize >> 24);
|
||||
|
||||
/* WAVE */
|
||||
fprintf(rec->fp, "WAVE");
|
||||
|
||||
/* fmt */
|
||||
fprintf(rec->fp, "fmt %c%c%c%c", (uint8_t)sizeof(fmt), 0, 0, 0);
|
||||
fmt.format = 1;
|
||||
fmt.channels = rec->channels;
|
||||
fmt.sample_rate = rec->samplerate; /* samples/sec */
|
||||
fmt.data_rate = rec->samplerate * 2 * rec->channels; /* full data rate */
|
||||
fmt.bytes_sample = 2 * rec->channels; /* all channels */
|
||||
fmt.bits_sample = 16; /* one channel */
|
||||
buffer[0] = fmt.format;
|
||||
buffer[1] = fmt.format >> 8;
|
||||
buffer[2] = fmt.channels;
|
||||
buffer[3] = fmt.channels >> 8;
|
||||
buffer[4] = fmt.sample_rate;
|
||||
buffer[5] = fmt.sample_rate >> 8;
|
||||
buffer[6] = fmt.sample_rate >> 16;
|
||||
buffer[7] = fmt.sample_rate >> 24;
|
||||
buffer[8] = fmt.data_rate;
|
||||
buffer[9] = fmt.data_rate >> 8;
|
||||
buffer[10] = fmt.data_rate >> 16;
|
||||
buffer[11] = fmt.data_rate >> 24;
|
||||
buffer[12] = fmt.bytes_sample;
|
||||
buffer[13] = fmt.bytes_sample >> 8;
|
||||
buffer[14] = fmt.bits_sample;
|
||||
buffer[15] = fmt.bits_sample >> 8;
|
||||
len = fwrite(buffer, 1, sizeof(fmt), rec->fp);
|
||||
|
||||
/* data */
|
||||
fprintf(rec->fp, "data%c%c%c%c", size & 0xff, (size >> 8) & 0xff, (size >> 16) & 0xff, size >> 24);
|
||||
|
||||
free(rec->buffer);
|
||||
rec->buffer = NULL;
|
||||
fclose(rec->fp);
|
||||
rec->fp = NULL;
|
||||
|
||||
PDEBUG(DWAVE, DEBUG_NOTICE, "*** WAVE file written.\n");
|
||||
}
|
||||
|
||||
void wave_destroy_playback(wave_play_t *play)
|
||||
{
|
||||
if (!play->fp)
|
||||
return;
|
||||
|
||||
/* finish thread if not already */
|
||||
play->finish = 1;
|
||||
pthread_join(play->tid, NULL);
|
||||
|
||||
free(play->buffer);
|
||||
play->buffer = NULL;
|
||||
fclose(play->fp);
|
||||
play->fp = NULL;
|
||||
}
|
||||
|
|
@ -1,37 +0,0 @@
|
|||
|
||||
typedef struct wave_rec {
|
||||
FILE *fp;
|
||||
int channels;
|
||||
double max_deviation;
|
||||
int samplerate;
|
||||
uint32_t written; /* how much samples written */
|
||||
/* thread stuff */
|
||||
pthread_t tid; /* file io thread id */
|
||||
int finish; /* indicates end of thread */
|
||||
uint8_t *buffer; /* buffer to store sample data */
|
||||
int buffer_size; /* size of buffer in bytes */
|
||||
int buffer_readp; /* read pointer to next byte in buffer */
|
||||
int buffer_writep; /* write pointer to next byte in buffer */
|
||||
} wave_rec_t;
|
||||
|
||||
typedef struct wave_play {
|
||||
FILE *fp;
|
||||
int channels;
|
||||
double max_deviation;
|
||||
uint32_t left; /* how much samples left */
|
||||
/* thread stuff */
|
||||
pthread_t tid; /* file io thread id */
|
||||
int finish; /* indicates end of thread */
|
||||
uint8_t *buffer; /* buffer to store sample data */
|
||||
int buffer_size; /* size of buffer in bytes */
|
||||
int buffer_readp; /* read pointer to next byte in buffer */
|
||||
int buffer_writep; /* write pointer to next byte in buffer */
|
||||
} wave_play_t;
|
||||
|
||||
int wave_create_record(wave_rec_t *rec, const char *filename, int samplerate, int channels, double max_deviation);
|
||||
int wave_create_playback(wave_play_t *play, const char *filename, int *samplerate_p, int *channels_p, double max_deviation);
|
||||
int wave_read(wave_play_t *play, sample_t **samples, int length);
|
||||
int wave_write(wave_rec_t *rec, sample_t **samples, int length);
|
||||
void wave_destroy_record(wave_rec_t *rec);
|
||||
void wave_destroy_playback(wave_play_t *play);
|
||||
|
|
@ -0,0 +1,30 @@
|
|||
AM_CPPFLAGS = -Wall -Wextra -g $(all_includes) -I../lib
|
||||
|
||||
bin_PROGRAMS = \
|
||||
uk0-soundcard
|
||||
|
||||
uk0_soundcard_SOURCES = \
|
||||
uk0.c \
|
||||
hdlc.c \
|
||||
ph_socket.c \
|
||||
main.c
|
||||
|
||||
uk0_soundcard_LDADD = \
|
||||
$(COMMON_LA) \
|
||||
../lib/libdebug/libdebug.a \
|
||||
../lib/liboptions/liboptions.a \
|
||||
../lib/libsample/libsample.a \
|
||||
../lib/libfilter/libfilter.a \
|
||||
../lib/libdisplay/libdisplay.a \
|
||||
../lib/libwave/libwave.a
|
||||
|
||||
if HAVE_ALSA
|
||||
uk0_soundcard_LDADD += \
|
||||
../lib/libsound/libsound.a \
|
||||
$(ALSA_LIBS)
|
||||
endif
|
||||
|
||||
if HAVE_ALSA
|
||||
AM_CPPFLAGS += -DHAVE_ALSA
|
||||
endif
|
||||
|
|
@ -0,0 +1,380 @@
|
|||
/* HDLC
|
||||
*
|
||||
* (C) 2022 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include <unistd.h>
|
||||
#include <errno.h>
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <libdebug/debug.h>
|
||||
#include "uk0.h"
|
||||
|
||||
//#define DEBUG_HDLC
|
||||
|
||||
/* calculate CRC from the bits of label and data and 16 zeroes.
|
||||
* the result is the remainder of the polynomial division and
|
||||
* conforms to HDLC/X25/ISDN standard.
|
||||
*/
|
||||
static uint16_t crc16(uint8_t *data, int length)
|
||||
{
|
||||
uint16_t generator = 0x8408;
|
||||
uint16_t crc = 0xffff; /* init crc register with 1 */
|
||||
int i, j;
|
||||
|
||||
for (i = 0; i < length; i++) {
|
||||
for (j = 0; j < 8; j++) {
|
||||
if (((data[i]>>j) & 1) != (crc & 1)) {
|
||||
crc = crc >> 1;
|
||||
crc = crc ^ generator;
|
||||
} else
|
||||
crc = crc >> 1;
|
||||
}
|
||||
}
|
||||
|
||||
return crc ^ 0xffff;
|
||||
}
|
||||
|
||||
/*
|
||||
* TX
|
||||
*/
|
||||
|
||||
void hdlc_tx_init(hdlc_tx_t *tx, struct uk0 *uk0, int channel, enum hdlc_mode mode)
|
||||
{
|
||||
memset(tx, 0, sizeof(*tx));
|
||||
tx->uk0 = uk0;
|
||||
tx->channel = channel;
|
||||
tx->mode = mode;
|
||||
}
|
||||
|
||||
static inline int tx_bit(hdlc_tx_t *tx, uint8_t *bit)
|
||||
{
|
||||
int subsequent = 0;
|
||||
|
||||
if (tx->state == HDLC_STATE_IDLE) {
|
||||
/* when index is set, we just had a frame, so we can use end flag as start flag */
|
||||
if (tx->index)
|
||||
subsequent = 1;
|
||||
tx->length = uk0_tx_dequeue(tx->uk0, tx->channel, tx->buffer, sizeof(tx->buffer));
|
||||
tx->index = 0;
|
||||
if (!tx->length)
|
||||
return -1; /* no more data */
|
||||
tx->crc = crc16(tx->buffer, tx->length);
|
||||
if (subsequent) {
|
||||
tx->state = HDLC_STATE_TX_DATA;
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("subsequent frame, continue with data.\n");
|
||||
#endif
|
||||
}
|
||||
else {
|
||||
tx->state = HDLC_STATE_TX_START_FLAG;
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("new frame after pause, continue with flag.\n");
|
||||
#endif
|
||||
}
|
||||
tx->bits = 0;
|
||||
tx->frame = 0x00;
|
||||
}
|
||||
|
||||
switch (tx->state) {
|
||||
case HDLC_STATE_TX_START_FLAG:
|
||||
*bit = (0x7e >> tx->bits) & 1;
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("transmit bit: %d\n", *bit);
|
||||
#endif
|
||||
if (++tx->bits == 8) {
|
||||
tx->bits = 0;
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("flag sent, continue with data.\n");
|
||||
#endif
|
||||
tx->state = HDLC_STATE_TX_DATA;
|
||||
}
|
||||
break;
|
||||
case HDLC_STATE_TX_DATA:
|
||||
if ((tx->frame & 0x1f) == 0x1f) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("insert stuffing bit.\n");
|
||||
#endif
|
||||
*bit = 0;
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("transmit bit: %d\n", *bit);
|
||||
#endif
|
||||
tx->frame <<= 1;
|
||||
break;
|
||||
}
|
||||
*bit = (tx->buffer[tx->index] >> tx->bits) & 1;
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("transmit bit: %d\n", *bit);
|
||||
#endif
|
||||
tx->frame <<= 1;
|
||||
tx->frame |= *bit;
|
||||
if (++tx->bits == 8) {
|
||||
tx->bits = 0;
|
||||
if (++tx->index == tx->length) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("data complete, continue with crc.\n");
|
||||
#endif
|
||||
tx->state = HDLC_STATE_TX_CRC;
|
||||
}
|
||||
}
|
||||
break;
|
||||
case HDLC_STATE_TX_CRC:
|
||||
if ((tx->frame & 0x1f) == 0x1f) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("insert stuffing bit.\n");
|
||||
#endif
|
||||
*bit = 0;
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("transmit bit: %d\n", *bit);
|
||||
#endif
|
||||
tx->frame <<= 1;
|
||||
break;
|
||||
}
|
||||
*bit = (tx->crc >> tx->bits) & 1;
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("transmit bit: %d\n", *bit);
|
||||
#endif
|
||||
tx->frame <<= 1;
|
||||
tx->frame |= *bit;
|
||||
if (++tx->bits == 16) {
|
||||
tx->bits = 0;
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("data complete, continue with end flag.\n");
|
||||
#endif
|
||||
tx->state = HDLC_STATE_TX_END_FLAG;
|
||||
}
|
||||
break;
|
||||
case HDLC_STATE_TX_END_FLAG:
|
||||
*bit = (0x7e >> tx->bits) & 1;
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("transmit bit: %d\n", *bit);
|
||||
#endif
|
||||
if (++tx->bits == 8) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("end flag complete, enter idle state for next frame.\n");
|
||||
#endif
|
||||
tx->state = HDLC_STATE_IDLE;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
return -1; /* should never happen */
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* data requested from uk0 coming from tx_queue */
|
||||
void uk0_send(uk0_t *uk0, int ch, uint8_t *data, int length)
|
||||
{
|
||||
hdlc_tx_t *tx;
|
||||
int i, j, rc;
|
||||
uint8_t bit;
|
||||
|
||||
if (ch < 1 || ch > 3) {
|
||||
fprintf(stderr, "%s: illegal channel number %d!\n", __func__, ch);
|
||||
return;
|
||||
}
|
||||
tx = &uk0->hdlc_tx[ch - 1];
|
||||
|
||||
/* disabled -> transparent */
|
||||
switch (tx->mode) {
|
||||
case HDLC_MODE_OFF:
|
||||
memset(data, 0xff, length);
|
||||
break;
|
||||
case HDLC_MODE_TRANS:
|
||||
while (length) {
|
||||
if (tx->index == tx->length) {
|
||||
tx->length = uk0_tx_dequeue(tx->uk0, tx->channel, tx->buffer, sizeof(tx->buffer));
|
||||
tx->index = 0;
|
||||
}
|
||||
if (!tx->length) {
|
||||
memset(data, 0xff, length);
|
||||
break;
|
||||
}
|
||||
while (length && tx->index < tx->length) {
|
||||
*data++ = tx->buffer[tx->index];
|
||||
tx->index++;
|
||||
length--;
|
||||
}
|
||||
}
|
||||
break;
|
||||
case HDLC_MODE_HDLC:
|
||||
for (i = 0; i < length; i++) {
|
||||
for (j = 0; j < 8; j++) {
|
||||
rc = tx_bit(tx, &bit);
|
||||
/* rc is set, if no more HDLC frames */
|
||||
if (rc)
|
||||
break;
|
||||
data[i] = (data[i] >> 1) | (bit << 7);
|
||||
}
|
||||
/* fill up byte, if no more HDLC frames */
|
||||
if (j < 8) {
|
||||
data[i] = (data[i] >> (8 - j)) | (0xff << j);
|
||||
i++;
|
||||
break;
|
||||
}
|
||||
}
|
||||
/* fill up remaining data with 0xff, if no more HDLC frames */
|
||||
if (i < length)
|
||||
memset(data + i , 0xff, length - i);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* RX
|
||||
*/
|
||||
|
||||
void hdlc_rx_init(hdlc_rx_t *rx, struct uk0 *uk0, int channel, enum hdlc_mode mode)
|
||||
{
|
||||
memset(rx, 0, sizeof(*rx));
|
||||
rx->uk0 = uk0;
|
||||
rx->channel = channel;
|
||||
rx->mode = mode;
|
||||
}
|
||||
|
||||
static inline void rx_frame(hdlc_rx_t *rx, uint8_t *data, int length)
|
||||
{
|
||||
uint16_t crc;
|
||||
|
||||
#ifdef DEBUG_HDLC
|
||||
int i;
|
||||
printf("frame:");
|
||||
for (i = 0; i < length; i++) {
|
||||
printf(" %02x", data[i]);
|
||||
}
|
||||
#endif
|
||||
crc = crc16(data, length - 2);
|
||||
if (data[length - 2] == (crc & 0xff) && data[length - 1] == (crc >> 8)) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf(" crc ok.\n");
|
||||
#endif
|
||||
ph_socket_tx_msg(&rx->uk0->ph_socket, rx->channel, PH_PRIM_DATA_IND, data, length - 2);
|
||||
} else {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf(" crc error!\n");
|
||||
#endif
|
||||
}
|
||||
}
|
||||
|
||||
static inline void rx_bit(hdlc_rx_t *rx, uint8_t bit)
|
||||
{
|
||||
rx->frame <<= 1;
|
||||
rx->frame |= bit;
|
||||
|
||||
switch (rx->state) {
|
||||
case HDLC_STATE_IDLE:
|
||||
if (rx->frame == 0x7e) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("received start flag.\n");
|
||||
#endif
|
||||
rx->state = HDLC_STATE_RX_FRAME;
|
||||
rx->index = 0;
|
||||
rx->bits = 0;
|
||||
}
|
||||
break;
|
||||
case HDLC_STATE_RX_FRAME:
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("received bit: %d\n", bit);
|
||||
#endif
|
||||
/* remove stuffed 0-bit after 5 1-bits */
|
||||
if ((rx->frame & 0x7f) == 0x3e) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("omit stuffed 0-bit.\n");
|
||||
#endif
|
||||
break;
|
||||
}
|
||||
if ((rx->frame & 0x7f) == 0x7f) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("received frame abort!\n");
|
||||
#endif
|
||||
rx->state = HDLC_STATE_IDLE;
|
||||
break;
|
||||
}
|
||||
if ((rx->frame & 0x7f) == 0x3f) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("received 6 1-bits.\n");
|
||||
#endif
|
||||
}
|
||||
rx->buffer[rx->index] >>= 1;
|
||||
rx->buffer[rx->index] |= (bit << 7);
|
||||
if (++rx->bits == 8) {
|
||||
rx->bits = 0;
|
||||
rx->index++;
|
||||
if (rx->index == sizeof(rx->buffer)) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("HDLC overflow!\n");
|
||||
#endif
|
||||
rx->state = HDLC_STATE_IDLE;
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (rx->frame == 0x7e) {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("received end flag.\n");
|
||||
#endif
|
||||
if (rx->bits == 0) {
|
||||
/* remove flag from buffer by substracting 1 from index */
|
||||
if (rx->index > 3)
|
||||
rx_frame(rx, rx->buffer, rx->index - 1);
|
||||
} else {
|
||||
#ifdef DEBUG_HDLC
|
||||
printf("received frame does not end on byte boundary!\n");
|
||||
#endif
|
||||
}
|
||||
rx->index = 0;
|
||||
rx->bits = 0;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
break; /* should never happen */
|
||||
}
|
||||
}
|
||||
|
||||
/* data from interface going through HDLC to socket */
|
||||
void uk0_receive(uk0_t *uk0, int ch, uint8_t *data, int length)
|
||||
{
|
||||
hdlc_rx_t *rx;
|
||||
int i, j;
|
||||
uint8_t bit;
|
||||
|
||||
if (ch < 1 || ch > 3) {
|
||||
fprintf(stderr, "%s: illegal channel number %d!\n", __func__, ch);
|
||||
return;
|
||||
}
|
||||
rx = &uk0->hdlc_rx[ch - 1];
|
||||
|
||||
/* disabled -> transparent */
|
||||
switch (rx->mode) {
|
||||
case HDLC_MODE_OFF:
|
||||
break;
|
||||
case HDLC_MODE_TRANS:
|
||||
ph_socket_tx_msg(&rx->uk0->ph_socket, rx->channel, PH_PRIM_DATA_IND, data, length);
|
||||
break;
|
||||
case HDLC_MODE_HDLC:
|
||||
for (i = 0; i < length; i++) {
|
||||
for (j = 0; j < 8; j++) {
|
||||
bit = (data[i] >> j) & 1;
|
||||
rx_bit(rx, bit);
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
|
@ -0,0 +1,42 @@
|
|||
|
||||
enum hdlc_mode {
|
||||
HDLC_MODE_OFF = 0,
|
||||
HDLC_MODE_TRANS,
|
||||
HDLC_MODE_HDLC,
|
||||
};
|
||||
|
||||
enum hdlc_state {
|
||||
HDLC_STATE_IDLE = 0, /* wait for flag / no data */
|
||||
HDLC_STATE_RX_FRAME, /* receive frame */
|
||||
HDLC_STATE_TX_START_FLAG,/* transmit flag */
|
||||
HDLC_STATE_TX_DATA, /* transmit data */
|
||||
HDLC_STATE_TX_CRC, /* transmit crc */
|
||||
HDLC_STATE_TX_END_FLAG, /* transmit flag */
|
||||
};
|
||||
|
||||
struct uk0;
|
||||
|
||||
typedef struct hdlc_tx {
|
||||
struct uk0 *uk0;
|
||||
int channel;
|
||||
enum hdlc_mode mode;
|
||||
enum hdlc_state state; /* current frame state */
|
||||
uint8_t frame; /* shit register to detect framing and stuffing */
|
||||
uint8_t buffer[65536];
|
||||
uint16_t crc;
|
||||
int length, index, bits;
|
||||
} hdlc_tx_t;
|
||||
|
||||
typedef struct hdlc_rx {
|
||||
struct uk0 *uk0;
|
||||
int channel;
|
||||
enum hdlc_mode mode;
|
||||
enum hdlc_state state; /* current frame state */
|
||||
uint8_t frame; /* shit register to detect framing and stuffing */
|
||||
uint8_t buffer[65537]; /* one more, because it contains end flag */
|
||||
int index, bits;
|
||||
} hdlc_rx_t;
|
||||
|
||||
void hdlc_tx_init(hdlc_tx_t *tx, struct uk0 *uk0, int channel, enum hdlc_mode mode);
|
||||
void hdlc_rx_init(hdlc_rx_t *rx, struct uk0 *uk0, int channel, enum hdlc_mode mode);
|
||||
|
|
@ -0,0 +1,442 @@
|
|||
/* UK0 via sound card (main)
|
||||
*
|
||||
* (C) 2022 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <unistd.h>
|
||||
#include <errno.h>
|
||||
#include <signal.h>
|
||||
#include <string.h>
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <termios.h>
|
||||
#include <time.h>
|
||||
#include <libdebug/debug.h>
|
||||
#include <liboptions/options.h>
|
||||
#include <libsample/sample.h>
|
||||
#include <libsound/sound.h>
|
||||
#include "uk0.h"
|
||||
|
||||
uk0_t *uk0[2] = { NULL, NULL };
|
||||
int num_kanal = 1;
|
||||
|
||||
void *soundif = NULL;
|
||||
const char *dsp_device = "";
|
||||
int dsp_samplerate = 192000;
|
||||
int dsp_buffer = 50;
|
||||
const char *uk0_socket[2] = { "/tmp/uk0", NULL };
|
||||
int num_uk0_socket = 0;
|
||||
static int keyboard_control = 0;
|
||||
static int dsp_interval = 1; /* ms */
|
||||
|
||||
static void print_usage(const char *app)
|
||||
{
|
||||
printf("Usage: %s [-a hw:0,0] [<options>]\n", app);
|
||||
}
|
||||
|
||||
static void print_help()
|
||||
{
|
||||
/* - - */
|
||||
printf(" -h --help\n");
|
||||
printf(" This help\n");
|
||||
printf(" --config [~/]<path to config file>\n");
|
||||
printf(" Give a config file to use. If it starts with '~/', path is at home dir.\n");
|
||||
printf(" Each line in config file is one option, '-' or '--' must not be given!\n");
|
||||
debug_print_help();
|
||||
printf(" -a --audio-device hw:<card>,<device>\n");
|
||||
printf(" Sound card and device number (default = '%s')\n", dsp_device);
|
||||
printf(" -s --samplerate <rate>\n");
|
||||
printf(" Sample rate of sound device (default = '%d')\n", dsp_samplerate);
|
||||
printf(" -b --buffer <ms>\n");
|
||||
printf(" How many milliseconds are processed in advance (default = '%d')\n", dsp_buffer);
|
||||
printf(" A buffer below 10 ms requires low interval like 0.1 ms.\n");
|
||||
printf(" -U --uk0-socket <filename>\n");
|
||||
printf(" Name to socket file. Allows an application to connect to layer 1.\n");
|
||||
printf(" (default = '%s')\n", uk0_socket[0]);
|
||||
printf(" To provide two interfaces with stereo audio, give two UK0 sockets:\n");
|
||||
printf(" -U <left> -U <right>\n");
|
||||
printf(" -C --control\n");
|
||||
printf(" Use keyboard to control activation/deactivation/loopback for testing.\n");
|
||||
printf("\n");
|
||||
printf("Press 'w' key to toggle display of RX wave form.\n");
|
||||
printf("Press 'm' key to toggle display of measurement values.\n");
|
||||
}
|
||||
|
||||
static void add_options(void)
|
||||
{
|
||||
option_add('h', "help", 0);
|
||||
option_add('v', "verbose", 1);
|
||||
option_add('a', "audio-device", 1);
|
||||
option_add('s', "samplerate", 1);
|
||||
option_add('b', "buffer", 1);
|
||||
option_add('U', "uk0-socket", 1);
|
||||
option_add('C', "control", 0);
|
||||
}
|
||||
|
||||
static int handle_options(int short_option, int argi, char **argv)
|
||||
{
|
||||
int rc;
|
||||
|
||||
switch (short_option) {
|
||||
case 'h':
|
||||
print_usage(argv[0]);
|
||||
print_help();
|
||||
return 0;
|
||||
case 'v':
|
||||
if (!strcasecmp(argv[argi], "list")) {
|
||||
debug_list_cat();
|
||||
return 0;
|
||||
}
|
||||
rc = parse_debug_opt(argv[argi]);
|
||||
if (rc < 0) {
|
||||
fprintf(stderr, "Failed to parse debug option, please use -h for help.\n");
|
||||
return rc;
|
||||
}
|
||||
break;
|
||||
case 'a':
|
||||
dsp_device = options_strdup(argv[argi]);
|
||||
break;
|
||||
case 's':
|
||||
dsp_samplerate = atoi(argv[argi]);
|
||||
break;
|
||||
case 'b':
|
||||
dsp_buffer = atoi(argv[argi]);
|
||||
break;
|
||||
case 'U':
|
||||
if (num_uk0_socket == 2) {
|
||||
fprintf(stderr, "Cannot provide more than two interfaces. Stereo audio allows just two interfaces.\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
uk0_socket[num_uk0_socket++] = options_strdup(argv[argi]);
|
||||
num_kanal = num_uk0_socket;
|
||||
break;
|
||||
case 'C':
|
||||
keyboard_control = 1;
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
return 1;
|
||||
}
|
||||
|
||||
static int quit = 0;
|
||||
static void sighandler(int sigset)
|
||||
{
|
||||
if (sigset == SIGHUP || sigset == SIGPIPE)
|
||||
return;
|
||||
|
||||
fprintf(stderr, "\nSignal %d received.\n", sigset);
|
||||
|
||||
quit = 1;
|
||||
}
|
||||
|
||||
static int get_char()
|
||||
{
|
||||
struct timeval tv = {0, 0};
|
||||
fd_set fds;
|
||||
char c = 0;
|
||||
int __attribute__((__unused__)) rc;
|
||||
|
||||
FD_ZERO(&fds);
|
||||
FD_SET(0, &fds);
|
||||
select(0+1, &fds, NULL, NULL, &tv);
|
||||
if (FD_ISSET(0, &fds)) {
|
||||
rc = read(0, &c, 1);
|
||||
return c;
|
||||
} else
|
||||
return -1;
|
||||
}
|
||||
|
||||
/* not static, in case we add libtimer some day, then compiler hits an error */
|
||||
double get_time(void)
|
||||
{
|
||||
static struct timespec tv;
|
||||
|
||||
clock_gettime(CLOCK_REALTIME, &tv);
|
||||
|
||||
return (double)tv.tv_sec + (double)tv.tv_nsec / 1000000000.0;
|
||||
}
|
||||
|
||||
static void help_keyboard(void)
|
||||
{
|
||||
printf("Use keyboard to control interface:\n");
|
||||
printf(" 'e' = enable interface (do this first!)\n");
|
||||
printf(" 'd' = disable interface\n");
|
||||
printf(" '1' = activate interface (LT side activation)\n");
|
||||
printf(" '0' = deactivate interface\n");
|
||||
printf(" 'l' = toggle loopback 2 mode\n");
|
||||
}
|
||||
|
||||
static void process_keyboard(uk0_t *uk0, char c)
|
||||
{
|
||||
switch (c) {
|
||||
case 'e':
|
||||
PDEBUG(DUK0, DEBUG_NOTICE, "Keyboard enables interface.\n");
|
||||
if (uk0->state != UK0_STATE_NULL) {
|
||||
PDEBUG(DUK0, DEBUG_NOTICE, "Interface is already enabled!\n");
|
||||
break;
|
||||
}
|
||||
uk0_handle_event(uk0, UK0_EVENT_ENABLE);
|
||||
break;
|
||||
case 'd':
|
||||
PDEBUG(DUK0, DEBUG_NOTICE, "Keyboard disables interface.\n");
|
||||
if (uk0->state == UK0_STATE_NULL) {
|
||||
PDEBUG(DUK0, DEBUG_NOTICE, "Interface is already disabled!\n");
|
||||
break;
|
||||
}
|
||||
uk0_handle_event(uk0, UK0_EVENT_DISABLE);
|
||||
break;
|
||||
case '1':
|
||||
PDEBUG(DUK0, DEBUG_NOTICE, "Keyboard activates interface.\n");
|
||||
if (uk0->state == UK0_STATE_NULL) {
|
||||
PDEBUG(DUK0, DEBUG_NOTICE, "Cannot activate interface, enable first!\n");
|
||||
break;
|
||||
}
|
||||
uk0_handle_event(uk0, UK0_EVENT_ACTIVATE);
|
||||
break;
|
||||
case '0':
|
||||
PDEBUG(DUK0, DEBUG_NOTICE, "Keyboard deactivates interface.\n");
|
||||
if (uk0->state == UK0_STATE_NULL) {
|
||||
PDEBUG(DUK0, DEBUG_NOTICE, "Cannot deactivate interface, it is disabled!\n");
|
||||
break;
|
||||
}
|
||||
uk0_handle_event(uk0, UK0_EVENT_DEACTIVATE);
|
||||
break;
|
||||
case 'l':
|
||||
uk0->loopback2 ^= 1;
|
||||
if (uk0->loopback2)
|
||||
PDEBUG(DUK0, DEBUG_NOTICE, "Keyboard activates loopback 2.\n");
|
||||
else
|
||||
PDEBUG(DUK0, DEBUG_NOTICE, "Keyboard deactivates loopback 2.\n");
|
||||
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
int soundif_open(const char *audiodev, int samplerate, int buffer_size)
|
||||
{
|
||||
if (!audiodev || !audiodev[0]) {
|
||||
PDEBUG(DUK0, DEBUG_ERROR, "No audio device given!\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/* open audiodev */
|
||||
#ifdef HAVE_ALSA
|
||||
soundif = sound_open(audiodev, NULL, NULL, NULL, num_kanal, 0.0, samplerate, buffer_size, 1.0, 1.0, 0.0, 2.0);
|
||||
if (!soundif) {
|
||||
PDEBUG(DUK0, DEBUG_ERROR, "Failed to open sound device!\n");
|
||||
return -EIO;
|
||||
}
|
||||
#else
|
||||
PDEBUG(DUK0, DEBUG_ERROR, "No audio device is compiled in! Cannot use UK0 interface.\n");
|
||||
return -EINVAL;
|
||||
#endif
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void soundif_start(void)
|
||||
{
|
||||
#ifdef HAVE_ALSA
|
||||
sound_start(soundif);
|
||||
PDEBUG(DUK0, DEBUG_DEBUG, "Starting audio stream!\n");
|
||||
#endif
|
||||
}
|
||||
|
||||
void soundif_close(void)
|
||||
{
|
||||
#ifdef HAVE_ALSA
|
||||
/* close audiodev */
|
||||
if (soundif) {
|
||||
sound_close(soundif);
|
||||
soundif = NULL;
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
void soundif_work(int buffer_size)
|
||||
{
|
||||
#ifdef HAVE_ALSA
|
||||
int count, i;
|
||||
sample_t buff[num_kanal][buffer_size], *samples[num_kanal];
|
||||
double rf_level_db[num_kanal];
|
||||
for (i = 0; i < num_kanal; i++)
|
||||
samples[i] = buff[i];
|
||||
int rc;
|
||||
|
||||
/* encode */
|
||||
count = sound_get_tosend(soundif, buffer_size);
|
||||
if (count < 0) {
|
||||
PDEBUG(DUK0, DEBUG_ERROR, "Failed to get number of samples in buffer (rc = %d)!\n", count);
|
||||
return;
|
||||
}
|
||||
if (count) {
|
||||
for (i = 0; i < num_kanal; i++)
|
||||
uk0_encode_mms43(uk0[i], samples[i], count);
|
||||
rc = sound_write(soundif, samples, NULL, count, NULL, NULL, num_kanal);
|
||||
if (rc < 0) {
|
||||
PDEBUG(DUK0, DEBUG_ERROR, "Failed to write TX data to audio device (rc = %d)\n", rc);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
/* decode */
|
||||
count = sound_read(soundif, samples, buffer_size, num_kanal, rf_level_db);
|
||||
if (count < 0) {
|
||||
PDEBUG(DUK0, DEBUG_ERROR, "Failed to read from audio device (rc = %d)!\n", count);
|
||||
return;
|
||||
}
|
||||
for (i = 0; i < num_kanal; i++)
|
||||
uk0_decode_mms43(uk0[i], samples[i], count);
|
||||
#endif
|
||||
}
|
||||
|
||||
int main(int argc, char *argv[])
|
||||
{
|
||||
int argi, rc;
|
||||
int buffer_size;
|
||||
struct termios term, term_orig;
|
||||
double begin_time, now, sleep;
|
||||
int i, j;
|
||||
char c;
|
||||
|
||||
|
||||
uk0_init();
|
||||
|
||||
/* handle options / config file */
|
||||
add_options();
|
||||
rc = options_config_file(argc, argv, "~/.osmocom/uk0/uk0.conf", handle_options);
|
||||
if (rc < 0)
|
||||
return 0;
|
||||
argi = options_command_line(argc, argv, handle_options);
|
||||
if (argi <= 0)
|
||||
return argi;
|
||||
|
||||
if (keyboard_control && num_kanal != 1) {
|
||||
PDEBUG(DUK0, DEBUG_ERROR, "Keyboard control works only, if a single UK0 interface was selected.\n");
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* size of dsp buffer in samples */
|
||||
buffer_size = dsp_samplerate * dsp_buffer / 1000;
|
||||
|
||||
rc = soundif_open(dsp_device, dsp_samplerate, buffer_size);
|
||||
if (rc < 0) {
|
||||
printf("Failed to open UK0 device, use '-h' for help.\n");
|
||||
goto error;
|
||||
}
|
||||
|
||||
/* create and init UK0 instances */
|
||||
for (i = 0; i < num_kanal; i++) {
|
||||
uk0[i] = uk0_create(uk0_socket[i], dsp_samplerate, buffer_size);
|
||||
if (!uk0[i])
|
||||
goto error;
|
||||
for (j = 0; j < 3; j++) {
|
||||
hdlc_tx_init(&uk0[i]->hdlc_tx[j], uk0[i], j + 1, HDLC_MODE_OFF);
|
||||
hdlc_rx_init(&uk0[i]->hdlc_rx[j], uk0[i], j + 1, HDLC_MODE_OFF);
|
||||
}
|
||||
ph_socket_init(&uk0[i]->ph_socket, uk0[i], uk0_socket[i], 1);
|
||||
}
|
||||
|
||||
if (keyboard_control)
|
||||
help_keyboard();
|
||||
|
||||
/* prepare terminal */
|
||||
tcgetattr(0, &term_orig);
|
||||
term = term_orig;
|
||||
term.c_lflag &= ~(ISIG|ICANON|ECHO);
|
||||
term.c_cc[VMIN]=1;
|
||||
term.c_cc[VTIME]=2;
|
||||
tcsetattr(0, TCSANOW, &term);
|
||||
|
||||
signal(SIGINT, sighandler);
|
||||
signal(SIGHUP, sighandler);
|
||||
signal(SIGTERM, sighandler);
|
||||
signal(SIGPIPE, sighandler);
|
||||
|
||||
soundif_start();
|
||||
|
||||
while (!quit) {
|
||||
int w;
|
||||
|
||||
begin_time = get_time();
|
||||
|
||||
soundif_work(buffer_size);
|
||||
for (i = 0; i < num_kanal; i++) {
|
||||
do {
|
||||
w = 0;
|
||||
w |= ph_socket_work(&uk0[i]->ph_socket);
|
||||
} while (w);
|
||||
}
|
||||
|
||||
c = get_char();
|
||||
switch (c) {
|
||||
case 3:
|
||||
printf("CTRL+c received, quitting!\n");
|
||||
quit = 1;
|
||||
break;
|
||||
case 'w':
|
||||
/* toggle wave display */
|
||||
display_measurements_on(0);
|
||||
display_wave_on(-1);
|
||||
break;
|
||||
case 'm':
|
||||
/* toggle measurements display */
|
||||
display_wave_on(0);
|
||||
display_measurements_on(-1);
|
||||
break;
|
||||
default:
|
||||
if (keyboard_control)
|
||||
process_keyboard(uk0[0], c);
|
||||
}
|
||||
|
||||
display_measurements(dsp_interval / 1000.0);
|
||||
|
||||
now = get_time();
|
||||
|
||||
/* sleep interval */
|
||||
sleep = ((double)dsp_interval / 1000.0) - (now - begin_time);
|
||||
if (sleep > 0)
|
||||
usleep(sleep * 1000000.0);
|
||||
}
|
||||
|
||||
signal(SIGINT, SIG_DFL);
|
||||
signal(SIGTSTP, SIG_DFL);
|
||||
signal(SIGHUP, SIG_DFL);
|
||||
signal(SIGTERM, SIG_DFL);
|
||||
signal(SIGPIPE, SIG_DFL);
|
||||
|
||||
/* reset terminal */
|
||||
tcsetattr(0, TCSANOW, &term_orig);
|
||||
|
||||
error:
|
||||
/* destroy UK0 instances */
|
||||
for (i = 0; i < num_kanal; i++) {
|
||||
if (uk0[i]) {
|
||||
ph_socket_exit(&uk0[i]->ph_socket);
|
||||
uk0_destroy(uk0[i]);
|
||||
}
|
||||
}
|
||||
|
||||
soundif_close();
|
||||
|
||||
options_free();
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
@ -0,0 +1,295 @@
|
|||
/* PH-socket, a lightweight ISDN physical layer interface
|
||||
*
|
||||
* (C) 2022 by Andreas Eversberg <jolly@eversberg.eu>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include <unistd.h>
|
||||
#include <fcntl.h>
|
||||
#include <errno.h>
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/socket.h>
|
||||
#include <time.h>
|
||||
#include <libdebug/debug.h>
|
||||
#include "ph_socket.h"
|
||||
|
||||
#define CHAN s->name
|
||||
|
||||
int ph_socket_init(ph_socket_t *s, void *priv, const char *socket_name, int server)
|
||||
{
|
||||
int rc, flags;
|
||||
|
||||
memset(s, 0, sizeof(*s));
|
||||
s->name = socket_name;
|
||||
s->priv = priv;
|
||||
s->tx_list_tail = &s->tx_list;
|
||||
|
||||
memset(&s->sock_address, 0, sizeof(s->sock_address));
|
||||
s->sock_address.sun_family = AF_UNIX;
|
||||
strncpy(s->sock_address.sun_path, socket_name, sizeof(s->sock_address.sun_path) - 1);
|
||||
|
||||
if (server) {
|
||||
unlink(socket_name);
|
||||
|
||||
rc = socket(PF_UNIX, SOCK_STREAM, 0);
|
||||
if (rc < 0) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_ERROR, "Failed to create UNIX socket.\n");
|
||||
return rc;
|
||||
}
|
||||
s->listen = rc;
|
||||
|
||||
rc = bind(s->listen, (struct sockaddr *)(&s->sock_address), SUN_LEN(&s->sock_address));
|
||||
if (rc < 0) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_ERROR, "Failed to bind UNIX socket with path '%s' (errno = %d (%s)).\n", socket_name, errno, strerror(errno));
|
||||
return rc;
|
||||
}
|
||||
|
||||
rc = listen(s->listen, 1);
|
||||
if (rc < 0) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_ERROR, "Failed to listen to UNIX socket with path '%s' (errno = %d (%s)).\n", socket_name, errno, strerror(errno));
|
||||
return rc;
|
||||
}
|
||||
|
||||
/* set nonblocking io */
|
||||
flags = fcntl(s->listen, F_GETFL);
|
||||
flags |= O_NONBLOCK;
|
||||
fcntl(s->listen, F_SETFL, flags);
|
||||
}
|
||||
|
||||
PDEBUG_CHAN(DPH, DEBUG_INFO, "Created PH-socket at '%s'.\n", socket_name);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void close_connection(ph_socket_t *s)
|
||||
{
|
||||
struct socket_msg_list *ml;
|
||||
uint8_t disable = PH_CTRL_DISABLE;
|
||||
|
||||
if (s->connect <= 0)
|
||||
return;
|
||||
|
||||
PDEBUG_CHAN(DPH, DEBUG_INFO, "Connection from PH-socket closed.\n");
|
||||
|
||||
/* indicate loss of socket connection */
|
||||
ph_socket_rx_msg(s, 0, (s->listen > 0) ? PH_PRIM_CTRL_REQ : PH_PRIM_CTRL_IND, &disable, 1);
|
||||
|
||||
close(s->connect);
|
||||
s->connect = 0;
|
||||
|
||||
while ((ml = s->tx_list)) {
|
||||
s->tx_list = ml->next;
|
||||
free(ml);
|
||||
}
|
||||
s->tx_list_tail = &s->tx_list;
|
||||
if (s->rx_msg) {
|
||||
free(s->rx_msg);
|
||||
s->rx_msg = NULL;
|
||||
}
|
||||
|
||||
/* set timer, so that retry is delayed */
|
||||
static struct timespec tv;
|
||||
clock_gettime(CLOCK_REALTIME, &tv);
|
||||
double now = (double)tv.tv_sec + (double)tv.tv_nsec / 1000000000.0;
|
||||
s->connect_timer = now + SOCKET_RETRY_TIMER;
|
||||
}
|
||||
|
||||
void ph_socket_exit(ph_socket_t *s)
|
||||
{
|
||||
PDEBUG_CHAN(DPH, DEBUG_INFO, "Destroyed PH-socket.\n");
|
||||
|
||||
close_connection(s);
|
||||
if (s->listen > 0) {
|
||||
close(s->listen);
|
||||
s->listen = 0;
|
||||
}
|
||||
}
|
||||
|
||||
int ph_socket_work(ph_socket_t *s)
|
||||
{
|
||||
uint8_t enable = PH_CTRL_ENABLE;
|
||||
int rc, flags;
|
||||
int work = 0;
|
||||
|
||||
if (s->listen > 0) {
|
||||
struct sockaddr_un sock_address;
|
||||
socklen_t sock_len = sizeof(sock_address);
|
||||
/* see if there is an incoming connection */
|
||||
rc = accept(s->listen, (struct sockaddr *)&sock_address, &sock_len);
|
||||
if (rc > 0) {
|
||||
if (s->connect > 0) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_ERROR, "Rejecting incoming connection, because we already have a client connected!\n");
|
||||
close(rc);
|
||||
} else {
|
||||
PDEBUG_CHAN(DPH, DEBUG_INFO, "Connection from PH-socket client.\n");
|
||||
s->connect = rc;
|
||||
/* set nonblocking io */
|
||||
flags = fcntl(s->connect, F_GETFL);
|
||||
flags |= O_NONBLOCK;
|
||||
fcntl(s->connect, F_SETFL, flags);
|
||||
/* reset rx buffer */
|
||||
s->rx_header_index = 0;
|
||||
s->rx_data_index = 0;
|
||||
/* indicate established socket connection */
|
||||
ph_socket_rx_msg(s, 0, PH_PRIM_CTRL_REQ, &enable, 1);
|
||||
}
|
||||
work = 1;
|
||||
}
|
||||
} else {
|
||||
/* open connection, if closed */
|
||||
if (s->connect <= 0) {
|
||||
static struct timespec tv;
|
||||
clock_gettime(CLOCK_REALTIME, &tv);
|
||||
double now = (double)tv.tv_sec + (double)tv.tv_nsec / 1000000000.0;
|
||||
if (s->connect_timer < now) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_DEBUG, "Trying to connect to PH-socket server.\n");
|
||||
rc = socket(PF_UNIX, SOCK_STREAM, 0);
|
||||
if (rc < 0) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_ERROR, "Failed to create UNIX socket.\n");
|
||||
s->connect_timer = now + SOCKET_RETRY_TIMER;
|
||||
return 0;
|
||||
}
|
||||
s->connect = rc;
|
||||
/* connect */
|
||||
rc = connect(s->connect, (struct sockaddr *)&s->sock_address, SUN_LEN(&s->sock_address));
|
||||
if (rc < 0 && errno != EAGAIN) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_NOTICE, "Failed to connect UNIX socket.\n");
|
||||
close(s->connect);
|
||||
s->connect = 0;
|
||||
s->connect_timer = now + SOCKET_RETRY_TIMER;
|
||||
return 0;
|
||||
}
|
||||
PDEBUG_CHAN(DPH, DEBUG_INFO, "Connection to PH-socket server.\n");
|
||||
/* set nonblocking io */
|
||||
flags = fcntl(s->connect, F_GETFL);
|
||||
flags |= O_NONBLOCK;
|
||||
fcntl(s->connect, F_SETFL, flags);
|
||||
/* reset rx buffer */
|
||||
s->rx_header_index = 0;
|
||||
s->rx_data_index = 0;
|
||||
/* indicate established socket connection */
|
||||
ph_socket_rx_msg(s, 0, PH_PRIM_CTRL_IND, &enable, 1);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* handle connection, if any */
|
||||
if (s->connect > 0) {
|
||||
if (!s->rx_msg)
|
||||
s->rx_msg = calloc(1, sizeof(*s->rx_msg));
|
||||
rx_again:
|
||||
if (s->rx_header_index < (int)sizeof(s->rx_msg->msg.header)) {
|
||||
/* read header until complete */
|
||||
rc = recv(s->connect, ((uint8_t *)&s->rx_msg->msg.header) + s->rx_header_index, sizeof(s->rx_msg->msg.header) - s->rx_header_index, 0);
|
||||
if (rc > 0) {
|
||||
s->rx_header_index += rc;
|
||||
work = 1;
|
||||
goto rx_again;
|
||||
} else if (rc == 0 || errno != EAGAIN) {
|
||||
close_connection(s);
|
||||
work = 1;
|
||||
}
|
||||
} else if (s->rx_data_index < s->rx_msg->msg.header.length) {
|
||||
/* read data until complete */
|
||||
rc = recv(s->connect, s->rx_msg->msg.data + s->rx_data_index, s->rx_msg->msg.header.length - s->rx_data_index, 0);
|
||||
if (rc > 0) {
|
||||
s->rx_data_index += rc;
|
||||
work = 1;
|
||||
goto rx_again;
|
||||
} else if (rc == 0 || errno != EAGAIN) {
|
||||
close_connection(s);
|
||||
work = 1;
|
||||
}
|
||||
} else {
|
||||
/* process and free message */
|
||||
if (s->rx_msg->msg.header.prim != PH_PRIM_DATA_REQ
|
||||
&& s->rx_msg->msg.header.prim != PH_PRIM_DATA_IND) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_DEBUG, "message 0x%02x channel %d from socket\n", s->rx_msg->msg.header.prim, s->rx_msg->msg.header.channel);
|
||||
if (s->rx_msg->msg.header.length)
|
||||
PDEBUG_CHAN(DPH, DEBUG_DEBUG, " -> data:%s\n", debug_hex(s->rx_msg->msg.data, s->rx_msg->msg.header.length));
|
||||
}
|
||||
ph_socket_rx_msg(s, s->rx_msg->msg.header.channel, s->rx_msg->msg.header.prim, s->rx_msg->msg.data, s->rx_msg->msg.header.length);
|
||||
free(s->rx_msg);
|
||||
s->rx_msg = NULL;
|
||||
/* reset rx buffer */
|
||||
s->rx_header_index = 0;
|
||||
s->rx_data_index = 0;
|
||||
}
|
||||
|
||||
tx_again:
|
||||
if (s->tx_list) {
|
||||
/* some frame in tx list, so try sending it */
|
||||
rc = send(s->connect, ((uint8_t *)&s->tx_list->msg.header), sizeof(s->tx_list->msg.header) + s->tx_list->msg.header.length, 0);
|
||||
if (rc > 0) {
|
||||
struct socket_msg_list *ml;
|
||||
if (rc != (int)sizeof(s->tx_list->msg.header) + s->tx_list->msg.header.length) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_ERROR, "Short write, please fix handling!\n");
|
||||
}
|
||||
/* remove list entry */
|
||||
ml = s->tx_list;
|
||||
s->tx_list = ml->next;
|
||||
if (s->tx_list == NULL)
|
||||
s->tx_list_tail = &s->tx_list;
|
||||
free(ml);
|
||||
work = 1;
|
||||
goto tx_again;
|
||||
} else if (rc == 0 || errno != EAGAIN) {
|
||||
close_connection(s);
|
||||
work = 1;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return work;
|
||||
}
|
||||
|
||||
void ph_socket_tx_msg(ph_socket_t *s, int channel, uint8_t prim, uint8_t *data, int length)
|
||||
{
|
||||
struct socket_msg_list *tx_msg;
|
||||
|
||||
if (prim != PH_PRIM_DATA_REQ
|
||||
&& prim != PH_PRIM_DATA_IND) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_DEBUG, "message 0x%02x channel %d to socket\n", prim, channel);
|
||||
if (length)
|
||||
PDEBUG_CHAN(DPH, DEBUG_DEBUG, " -> data:%s\n", debug_hex(data, length));
|
||||
}
|
||||
|
||||
if (length > (int)sizeof(tx_msg->msg.data)) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_NOTICE, "Frame from HDLC process too large for socket, dropping!\n");
|
||||
return;
|
||||
}
|
||||
|
||||
if (s->connect <= 0) {
|
||||
PDEBUG_CHAN(DPH, DEBUG_NOTICE, "Dropping message for socket, socket is closed!\n");
|
||||
return;
|
||||
}
|
||||
|
||||
tx_msg = calloc(1, sizeof(*tx_msg));
|
||||
tx_msg->msg.header.channel = channel;
|
||||
tx_msg->msg.header.prim = prim;
|
||||
if (length) {
|
||||
tx_msg->msg.header.length = length;
|
||||
memcpy(tx_msg->msg.data, data, length);
|
||||
}
|
||||
/* move message to list */
|
||||
*s->tx_list_tail = tx_msg;
|
||||
s->tx_list_tail = &tx_msg->next;
|
||||
}
|
||||
|
|
@ -0,0 +1,102 @@
|
|||
|
||||
#include <sys/un.h>
|
||||
|
||||
/*
|
||||
* Procedure:
|
||||
*
|
||||
* If socket connection is establised, a PH_PRIM_CTRL_REQ message with
|
||||
* PH_CTRL_ENABLE information is received by the socket server user.
|
||||
* If the socket connection is lost, a PH_PRIM_CTRL_REQ message with
|
||||
* PH_CTRL_DISABLE information is received by the user.
|
||||
*
|
||||
* If socket connection is establised, a PH_PRIM_CTRL_IND message with
|
||||
* PH_CTRL_ENABLE information is received by the socket client user.
|
||||
* If the socket connection is lost, a PH_PRIM_CTRL_IND message with
|
||||
* PH_CTRL_DISABLE information is received by the user.
|
||||
*
|
||||
* The socket server should activate or deactivate interface depending
|
||||
* on the PH_CTRL_ENABEL / PH_CTRL_DISABLE information.
|
||||
*
|
||||
* The socket client user shall keep track of last PH_PRIM_ACT_IND /
|
||||
* PH_PRIM_DEACT_IND message and treat a PH_PRIM_CTRL_IND message with
|
||||
* PH_CTRL_DISABLE information as a deactivation of all channels that
|
||||
* were activated. Also it shall reject every PH_RIM_ACT_REQ with a
|
||||
* PH_PRIM_DACT_IND, if the socket is currently unavailable.
|
||||
*
|
||||
* PH_PRIM_CTRL_REQ and PH_PRIM_CTRL_IND messages with PH_CTRL_ENABLE
|
||||
* and PH_CTRL_DISABLE informations are not assoicated with a channel
|
||||
* number. The socket sender shall set it to 0, the receiver shall
|
||||
* ignore it.
|
||||
*
|
||||
* A missing MODE in PH_PRIM_ACT_REQ is interepreted as default:
|
||||
* HDLC on D-channel, TRANS on B-channel.
|
||||
*
|
||||
* Each packet on the socket shall have the follwoing header:
|
||||
* uint8_t channel;
|
||||
* uint8_t prim;
|
||||
* uint16_t length;
|
||||
*
|
||||
* The length shall be in host's endian on UN sockets and in network
|
||||
* endian on TCP sockets and not being transmitted on UDP sockets.
|
||||
*
|
||||
* 0 to 65535 bytes shall follow the header, depending on the length
|
||||
* information field.
|
||||
*/
|
||||
|
||||
/* all primitives */
|
||||
#define PH_PRIM_DATA_REQ 0x00 /* any data sent to channel from upper layer */
|
||||
#define PH_PRIM_DATA_IND 0x01 /* any data received from channel to upper layer */
|
||||
|
||||
#define PH_PRIM_CTRL_REQ 0x04 /* implementation specific requests towards interface */
|
||||
#define PH_PRIM_CTRL_IND 0x05 /* implementation specific indications from interface */
|
||||
|
||||
#define PH_PRIM_ACT_REQ 0x08 /* activation request of channel, mode is given as payload */
|
||||
#define PH_PRIM_ACT_IND 0x09 /* activation indication that the channel is now active */
|
||||
|
||||
#define PH_PRIM_DACT_REQ 0x0c /* deactivation request of channel */
|
||||
#define PH_PRIM_DACT_IND 0x0d /* deactivation indication that the channel is now inactive */
|
||||
|
||||
/* one byte sent activation request */
|
||||
#define PH_MODE_TRANS 0x00 /* raw data is sent via B-channel */
|
||||
#define PH_MODE_HDLC 0x01 /* HDLC transcoding is performed via B-channel */
|
||||
|
||||
/* one byte sent with control messages */
|
||||
#define PH_CTRL_DISABLE 0x00 /* disable (block) interface, when socket is disconnected */
|
||||
#define PH_CTRL_ENABLE 0x01 /* enable (unblock) interface, when socket is connected */
|
||||
|
||||
struct socket_msg {
|
||||
struct {
|
||||
uint8_t channel;
|
||||
uint8_t prim;
|
||||
uint16_t length;
|
||||
} header;
|
||||
uint8_t data[65536];
|
||||
} __attribute__((packed));
|
||||
|
||||
struct socket_msg_list {
|
||||
struct socket_msg_list *next;
|
||||
struct socket_msg msg;
|
||||
};
|
||||
|
||||
#define SOCKET_RETRY_TIMER 2.0
|
||||
|
||||
typedef struct ph_socket {
|
||||
const char *name;
|
||||
void *priv;
|
||||
struct sockaddr_un sock_address;
|
||||
int listen; /* socket to listen to incoming connections */
|
||||
int connect; /* socket of incoming connection */
|
||||
double connect_timer; /* time when to connect again */
|
||||
struct socket_msg_list *tx_list, **tx_list_tail;
|
||||
struct socket_msg_list *rx_msg;
|
||||
int rx_header_index;
|
||||
int rx_data_index;
|
||||
} ph_socket_t;
|
||||
|
||||
int ph_socket_init(ph_socket_t *s, void *priv, const char *socket_name, int server);
|
||||
void ph_socket_exit(ph_socket_t *s);
|
||||
void ph_socket_tx_msg(ph_socket_t *s, int channel, uint8_t prim, uint8_t *data, int length);
|
||||
void ph_socket_rx_msg(ph_socket_t *s, int channel, uint8_t prim, uint8_t *data, int length);
|
||||
int ph_socket_work(ph_socket_t *s);
|
||||
|
||||
|
File diff suppressed because it is too large
Load Diff
|
@ -0,0 +1,137 @@
|
|||
|
||||
#include <libsample/sample.h>
|
||||
#include <libfilter/iir_filter.h>
|
||||
#include <libwave/wave.h>
|
||||
#include <libdisplay/display.h>
|
||||
#include "hdlc.h"
|
||||
#include "ph_socket.h"
|
||||
|
||||
#define TX_NUM_B 64 /* must be a multiple of 8 (one frame) */
|
||||
#define TX_NUM_D 16 /* must be a multiple of 2 (one frame) */
|
||||
|
||||
typedef struct uk0_tx {
|
||||
double phase, phase_step;
|
||||
int index;
|
||||
double level, last_level;
|
||||
uint64_t buffer[8]; /* 256 symbols */
|
||||
int frame_length;
|
||||
int frame_index;
|
||||
uint8_t mms43_column;
|
||||
uint32_t scramble;
|
||||
uint8_t B1[TX_NUM_B], B2[TX_NUM_B], D[TX_NUM_D];
|
||||
int b_count, d_count;
|
||||
} uk0_tx_t;
|
||||
|
||||
#define RX_NUM_B 64 /* must be a multiple of 8 (one frame) */
|
||||
#define RX_NUM_D 16 /* must be a multiple of 2 (one frame) */
|
||||
|
||||
typedef struct uk0_rx {
|
||||
wave_rec_t rec;
|
||||
double *sinc;
|
||||
double *window;
|
||||
int window_length;
|
||||
double last_level;
|
||||
double phase, phase_step; /* uncorrected phase */
|
||||
double sample_phase; /* corrected phase for sample point */
|
||||
iir_filter_t lp[2]; /* filters received IQ signal */
|
||||
double count_ms, ms_per_sample; /* counter when to correct phase */
|
||||
double min, max;
|
||||
double zero, low, high, low_threshold, high_threshold, rx_level;
|
||||
uint64_t buffer[4];
|
||||
int u0_detect; /* counter to detect LOS */
|
||||
int u1w_count; /* counter to detect cease of U1W */
|
||||
int u1a_count, u1a_detect; /* counters to detect U1A */
|
||||
int sync_count, sync_symbols;
|
||||
uint64_t sync_last;
|
||||
uint32_t descramble;
|
||||
uint8_t B1[RX_NUM_B], B2[RX_NUM_B], D[RX_NUM_D];
|
||||
int b_count, d_count;
|
||||
} uk0_rx_t;
|
||||
|
||||
enum uk0_state {
|
||||
/* interface off */
|
||||
UK0_STATE_NULL = 0,
|
||||
/* deactivated state, waiting for LT or NT activation */
|
||||
UK0_STATE_LT_1_1,
|
||||
/* got U1W, send U2W */
|
||||
UK0_STATE_LT_1_2,
|
||||
/* got activation from LT, send U2W */
|
||||
UK0_STATE_LT_1_3,
|
||||
/* wait for U1 or U3 */
|
||||
UK0_STATE_LT_1_4,
|
||||
/* wait for U3 */
|
||||
UK0_STATE_LT_1_5,
|
||||
/* send U4H */
|
||||
UK0_STATE_LT_1_6,
|
||||
/* send U4 */
|
||||
UK0_STATE_LT_1_7,
|
||||
/* wait for U0 */
|
||||
UK0_STATE_LT_1_8,
|
||||
};
|
||||
|
||||
enum uk0_event {
|
||||
UK0_EVENT_DISABLE = 0,
|
||||
UK0_EVENT_ENABLE,
|
||||
UK0_EVENT_DEACTIVATE,
|
||||
UK0_EVENT_ACTIVATE,
|
||||
UK0_EVENT_TIMEOUT,
|
||||
UK0_EVENT_U0,
|
||||
UK0_EVENT_U1W,
|
||||
UK0_EVENT_U1A,
|
||||
UK0_EVENT_U1,
|
||||
UK0_EVENT_U3,
|
||||
UK0_EVENT_U5,
|
||||
UK0_EVENT_SP,
|
||||
UK0_EVENT_ANY,
|
||||
};
|
||||
|
||||
struct tx_queue {
|
||||
struct tx_queue *next;
|
||||
int length;
|
||||
uint8_t data[0];
|
||||
};
|
||||
|
||||
typedef struct uk0 {
|
||||
const char *name;
|
||||
enum uk0_state state;
|
||||
int loopback2;
|
||||
int ti1, ti2, timer;
|
||||
uk0_tx_t tx;
|
||||
uk0_rx_t rx;
|
||||
hdlc_tx_t hdlc_tx[3];
|
||||
hdlc_rx_t hdlc_rx[3];
|
||||
struct tx_queue *tx_queue[3], **tx_queue_tail[3];
|
||||
int tx_queue_size[3];
|
||||
ph_socket_t ph_socket;
|
||||
|
||||
/* measurements */
|
||||
int measure_level_interval;
|
||||
int measure_level_index;
|
||||
double measure_level_error;
|
||||
int measure_frame_interval;
|
||||
int measure_frame_index;
|
||||
int measure_frame_error;
|
||||
dispmeas_t dispmeas; /* display measurements */
|
||||
dispmeasparam_t *dmp_level;
|
||||
dispmeasparam_t *dmp_level_error;
|
||||
|
||||
/* wave */
|
||||
dispwav_t dispwav; /* display wave form */
|
||||
|
||||
} uk0_t;
|
||||
|
||||
void uk0_init(void);
|
||||
uk0_t *uk0_create(const char *name, int samplerate, int buffer_size);
|
||||
void uk0_start(uk0_t *uk0);
|
||||
void uk0_destroy(uk0_t *uk0);
|
||||
void uk0_work(uk0_t *uk0, int buffer_size);
|
||||
void uk0_send(uk0_t *uk0, int ch, uint8_t *data, int length);
|
||||
void uk0_receive(uk0_t *uk0, int ch, uint8_t *data, int length);
|
||||
void uk0_handle_event(uk0_t *uk0, enum uk0_event event);
|
||||
void uk0_encode_mms43(uk0_t *uk0, sample_t *samples, int length);
|
||||
void uk0_decode_mms43(uk0_t *uk0, sample_t *samples, int length);
|
||||
|
||||
void uk0_tx_flush(uk0_t *uk0, int channel);
|
||||
void uk0_tx_enqueue(uk0_t *uk0, int channel, uint8_t *data, int length);
|
||||
int uk0_tx_dequeue(uk0_t *uk0, int channel, uint8_t *data, int size);
|
||||
|
Loading…
Reference in New Issue