Code generation
Least squares solvers feature many policies as explained here.
Most of these policies are reflected in the solvers’ control-flow.
Hence, a library typically has the choice of either trying to cover all possible combinations or ignoring some/most of these combinations.
The former case leads to an “API explosion” where the library provides a vast amount of dedicated functions that closely resemble each other and must encode the policy in its name and arguments.
As an alternative, hddc2b only provides the building blocks of such solvers while relying on a configuration file and a code generator to realize the specific solver required by the concrete application.
Domain-specific language for configuration
The configuration is provided as a simple JSON file with the following structure and semantics. Required data types are typographically indicated by a [bold font].
Generator configuration
The top-level JSON object with the following properties.
@context: must be any valid JSON-LD context that defines the used terms. A convenience option is to use the providedhddc2b.context.jsoncontext.@type: must either be a [string] with the value or an [array of strings] containingGeneratorConfigurationsolvers: an array of objects, each containing a solver configuration
The first two properties, starting with an @, indicate the file’s conformance to JSON-LD.
They are optional (as long as the SHACL validation is not required), yet recommended and allow us to connect the JSON file to the Semantic Web.
Solver configuration
Each solver configuration object must be comprised of the following properties.
name[string]: a valid C identifier that will be the name of the generated functionquantity[string]: indicate for which physical quantity this solver is meant to be. The value must either beforcefor force-level solvers; orvelocityfor velocity-level solvers.
direction[string, optional]: indicate the direction in which the physical quantity is mapped. The value must either bedistributionfor mapping from platform space to drive space; orcompositionfor mapping from drive space to platform space.
If omitted, the historical defaults are preserved:
forceselectsdistributionandvelocityselectscomposition. The four combinations therefore represent:force+distribution: distribute a platform force to drive forces.force+composition: compose drive forces to a platform force.velocity+composition: compose drive velocities to a platform velocity.velocity+distribution: distribute a platform velocity to drive velocities.
preprocess-platform-weight[boolean]: determine whether to preprocess the platform weight matrix in the solver or if it is passed in as an argument (see also “Cheating”).For force solvers this will compute the square root of that matrix.
For velocity solvers this will compute the inverse square root of that matrix.
preprocess-drive-weight[boolean]: determine whether to preprocess the drive weight matrix in the solver or if it is passed in as an argument (see also “Cheating”).For force solvers this will compute the inverse square root of that matrix.
For velocity solvers this will compute the square root of that matrix.
weight-in-platform-space[boolean]: use this flag when the platform may be(come) singularweight-in-drive-space[boolean]: use this flag when the platform may be(come) redundanthas-secondary-task[boolean]: use this flag to indicate if the solver should handle a lower-priority task that will be projected into the nullspace of the platform task.For the force distribution solver the secondary task is specified in the drive space (e.g. for aligning the drive units with a lower priority than solving the platform-level task).
For the velocity composition solver the secondary task is specified in the platform space.
The velocity distribution solver must not set this property: the platform-to-pivot map is unique, so it has no nullspace for a secondary task to act in. Use
alignmentinstead.
inverse[string]: the type of inverse to compute. The value must either bepseudoinversefor computing a (scalar) pseudoinverse; ordamped-least-squaresfor computing a damped inverse akin to ridge regression.
The next three properties only apply to the velocity distribution solver; every other solver must omit them.
alignment[string, optional]: determine whether the solver steers the drives’ castors towards their rolling direction. The value must either benone(the default) for distributing the commanded twist as it is; ortwist-relaxationfor treating the castor alignment as a lower-priority task.
Because the platform-to-pivot map is unique there is no nullspace to project such a task into, so
twist-relaxationinstead lets the alignment task modify the commanded twist itself, weighted against a platform tracking weight. The solver then takes the tracking weight, the per-drive alignment weights, an alignment time constant and a maximum castor rate as additional arguments, and reports the resulting twist asxd_pltf_eff.output[string, optional]: the level at which the distribution stops. The value must either bepivot(the default) for stopping at the drives’ pivot velocities; orhubfor continuing through the castor and wheel kinematics to the wheel-hub velocities.
The
hubsolver additionally takes the wheel geometry (diameter, wheel distance and castor offset) and returns the hub velocities alongside the pivot velocities.wheel-speed-limit[boolean, optional]: use this flag to scale the twist down until every wheel-hub speed is within a commanded maximum. Because the whole chain is linear, the twist, the pivot velocities and the hub velocities are scaled by the same factor and stay consistent with each other. This requiresoutputto behub, as only that solver produces the hub speeds.description: an array of strings that will be used as a comment in the generated header file
Validation
The configuration can be validated in two ways, either via SHACL constraints or JSON-Schema.
The SHACL constraint check requires the JSON-LD keywords @context and @type to be present.
Then execute the following command in the generator/ folder:
make shacl
The JSON-Schema check works without the JSON-LD keywords and can be invoked via
make schema
Code generation and embedding into a project
When the configuration is valid, the C code can be generated using the Jinja2 template engine and the associated templates. The following command only prints the generated code to the terminal.
make jinja
Alternatively, the hddc2b tests provide a CMake example on how to trigger the code generator at build time and compile the generated code as part of a project.
The generated code assumes that the solver’s header file solver.h is available to the C compiler via an include directory.
The hddc2b example demonstrate this for a CMake project:
target_include_directories(hddc2b_example
PRIVATE
${CMAKE_CURRENT_SOURCE_DIR}
)
Licensing
All generator-related tooling (templates, schemata, or the example configuration) are licenced under the MIT No Attribution Licence. It is provided as a reference implementation that can be used, modified and even relicensed without restrictions By design, the MIT No Attribution licence does not even have to be mentioned in any derivative work. The same also applies to the generated code.