1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
|
/*
* Grid.h
*
* Created on: 18 Nov 2016
* Author: David
*/
#ifndef SRC_MOVEMENT_GRID_H_
#define SRC_MOVEMENT_GRID_H_
#include <cstdint>
#include "ecv.h"
#include "Libraries/General/StringRef.h"
#include "Configuration.h"
class FileStore;
// This class defines the bed probing grid
class GridDefinition
{
public:
friend class HeightMap;
GridDefinition();
GridDefinition(const float xRange[2], const float yRange[2], float pRadius, float pSpacing);
uint32_t NumXpoints() const { return numX; }
uint32_t NumYpoints() const { return numY; }
uint32_t NumPoints() const { return numX * numY; }
float GetXCoordinate(unsigned int xIndex) const;
float GetYCoordinate(unsigned int yIndex) const;
bool IsInRadius(float x, float y) const;
bool IsValid() const { return isValid; }
void PrintParameters(StringRef& r) const;
void WriteHeadingAndParameters(StringRef& r) const;
static bool CheckHeading(const StringRef& s);
bool ReadParameters(const StringRef& s);
void PrintError(StringRef& r) const
pre(!IsValid());
private:
void CheckValidity();
static constexpr float MinSpacing = 0.1; // The minimum point spacing allowed
static constexpr float MinRange = 1.0; // The minimum X and Y range allowed
static const char *HeightMapLabelLine; // The line we write to the height map file listing the parameter names
// Primary parameters
float xMin, xMax, yMin, yMax; // The edges of the grid for G29 probing
float radius; // The grid radius to probe
float spacing; // The spacing of the grid probe points
// Derived parameters
uint32_t numX, numY;
float recipSpacing;
bool isValid;
};
// Class to represent the height map
class HeightMap
{
public:
HeightMap(float *heightStorage);
const GridDefinition& GetGrid() const { return def; }
void SetGrid(const GridDefinition& gd);
float ComputeHeightError(float x, float y, float z) const; // Compute the height error at the specified point
float ComputeInverseHeightError(float x, float y, float z) const; // Compute the inverse height error at the specified point
void ClearGridHeights(); // Clear all grid height corrections
void SetGridHeight(size_t xIndex, size_t yIndex, float height); // Set the height of a grid point
bool SaveToFile(FileStore *f) const // Save the grid to file returning true if an error occurred
pre(IsValid());
bool LoadFromFile(FileStore *f, StringRef& r); // Load the grid from file returning true if an error occurred
unsigned int GetMinimumSegments(float distance) const; // Return the minimum number of segments for a move by this X or Y amount
void UseHeightMap(bool b);
bool UsingHeightMap() const { return useMap; }
float GetTaperHeight() const { return (useTaper) ? taperHeight : 0.0; }
void SetTaperHeight(float h);
unsigned int GetStatistics(float& mean, float& deviation) const; // Return number of points probed, mean and RMS deviation
private:
static const char *HeightMapComment; // The start of the comment we write at the start of the height map file
GridDefinition def;
float *gridHeights; // The map of grid heights, must have at least MaxGridProbePoints entries
uint32_t gridHeightSet[MaxGridProbePoints/32]; // Bitmap of which heights are set
float taperHeight; // Height over which we taper
float recipTaperHeight; // Reciprocal of the taper height
bool useMap; // True to do bed compensation
bool useTaper; // True to taper off the compensation
uint32_t GetMapIndex(uint32_t xIndex, uint32_t yIndex) const { return (yIndex * def.NumXpoints()) + xIndex; }
bool IsHeightSet(uint32_t index) const { return (gridHeightSet[index/32] & (1 << (index & 31))) != 0; }
float GetInterpolatedHeightError(float x, float y) const // Compute the interpolated height error at the specified point
pre(useMap);
float GetHeightError(uint32_t xIndex, uint32_t yIndex) const;
float InterpolateX(uint32_t xIndex, uint32_t yIndex, float xFrac) const;
float InterpolateY(uint32_t xIndex, uint32_t yIndex, float yFrac) const;
float InterpolateXY(uint32_t xIndex, uint32_t yIndex, float xFrac, float yFrac) const;
float Interpolate2(uint32_t index1, uint32_t index2, float frac) const;
float InterpolateCorner(uint32_t cornerIndex, uint32_t indexX, uint32_t indexY, float xFrac, float yFrac) const;
};
#endif /* SRC_MOVEMENT_GRID_H_ */
|
