My Marlin configs for Fabrikator Mini and CTC i3 Pro B
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

mesh_bed_leveling.h 1.7KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657
  1. #include "Marlin.h"
  2. #if defined(MESH_BED_LEVELING)
  3. #define MESH_X_DIST ((MESH_MAX_X - MESH_MIN_X)/(MESH_NUM_X_POINTS - 1))
  4. #define MESH_Y_DIST ((MESH_MAX_Y - MESH_MIN_Y)/(MESH_NUM_Y_POINTS - 1))
  5. class mesh_bed_leveling {
  6. public:
  7. uint8_t active;
  8. float z_values[MESH_NUM_Y_POINTS][MESH_NUM_X_POINTS];
  9. mesh_bed_leveling();
  10. void reset();
  11. float get_x(int i) { return MESH_MIN_X + MESH_X_DIST * i; }
  12. float get_y(int i) { return MESH_MIN_Y + MESH_Y_DIST * i; }
  13. void set_z(int ix, int iy, float z) { z_values[iy][ix] = z; }
  14. int select_x_index(float x) {
  15. int i = 1;
  16. while (x > get_x(i) && i < MESH_NUM_X_POINTS-1) i++;
  17. return i - 1;
  18. }
  19. int select_y_index(float y) {
  20. int i = 1;
  21. while (y > get_y(i) && i < MESH_NUM_Y_POINTS - 1) i++;
  22. return i - 1;
  23. }
  24. float calc_z0(float a0, float a1, float z1, float a2, float z2) {
  25. float delta_z = (z2 - z1)/(a2 - a1);
  26. float delta_a = a0 - a1;
  27. return z1 + delta_a * delta_z;
  28. }
  29. float get_z(float x0, float y0) {
  30. int x_index = select_x_index(x0);
  31. int y_index = select_y_index(y0);
  32. float z1 = calc_z0(x0,
  33. get_x(x_index), z_values[y_index][x_index],
  34. get_x(x_index+1), z_values[y_index][x_index+1]);
  35. float z2 = calc_z0(x0,
  36. get_x(x_index), z_values[y_index+1][x_index],
  37. get_x(x_index+1), z_values[y_index+1][x_index+1]);
  38. float z0 = calc_z0(y0,
  39. get_y(y_index), z1,
  40. get_y(y_index+1), z2);
  41. return z0;
  42. }
  43. };
  44. extern mesh_bed_leveling mbl;
  45. #endif // MESH_BED_LEVELING