first_lay_cal.cpp 7.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206
  1. //! @file
  2. //! @date Jun 10, 2019
  3. //! @author Marek Bel
  4. //! @brief First layer (Z offset) calibration
  5. #include "first_lay_cal.h"
  6. #include "Configuration_prusa.h"
  7. #include "language.h"
  8. #include "Marlin.h"
  9. #include "cmdqueue.h"
  10. #include "mmu2.h"
  11. #include <avr/pgmspace.h>
  12. //! @brief Wait for preheat
  13. void lay1cal_wait_preheat()
  14. {
  15. const char * const preheat_cmd[] =
  16. {
  17. PSTR("M107"),
  18. PSTR("M190"),
  19. PSTR("M109"),
  20. PSTR("G28"),
  21. PSTR("G92 E0.0")
  22. };
  23. for (uint8_t i = 0; i < (sizeof(preheat_cmd)/sizeof(preheat_cmd[0])); ++i)
  24. {
  25. enquecommand_P(preheat_cmd[i]);
  26. }
  27. }
  28. //! @brief Load filament
  29. //! @param cmd_buffer character buffer needed to format gcodes
  30. //! @param filament filament to use (applies for MMU only)
  31. void lay1cal_load_filament(char *cmd_buffer, uint8_t filament)
  32. {
  33. if (MMU2::mmu2.Enabled())
  34. {
  35. enquecommand_P(PSTR("M83"));
  36. enquecommand_P(PSTR("G1 Y-3.0 F1000.0"));
  37. enquecommand_P(PSTR("G1 Z0.4 F1000.0"));
  38. sprintf_P(cmd_buffer, PSTR("T%d"), filament);
  39. enquecommand(cmd_buffer);
  40. }
  41. }
  42. //! @brief Print intro line
  43. void lay1cal_intro_line()
  44. {
  45. static const char cmd_intro_mmu_3[] PROGMEM = "G1 X55.0 E32.0 F1073.0";
  46. static const char cmd_intro_mmu_4[] PROGMEM = "G1 X5.0 E32.0 F1800.0";
  47. static const char cmd_intro_mmu_5[] PROGMEM = "G1 X55.0 E8.0 F2000.0";
  48. static const char cmd_intro_mmu_6[] PROGMEM = "G1 Z0.3 F1000.0";
  49. static const char cmd_intro_mmu_7[] PROGMEM = "G92 E0.0";
  50. static const char cmd_intro_mmu_8[] PROGMEM = "G1 X240.0 E25.0 F2200.0";
  51. static const char cmd_intro_mmu_9[] PROGMEM = "G1 Y-2.0 F1000.0";
  52. static const char cmd_intro_mmu_10[] PROGMEM = "G1 X55.0 E25 F1400.0";
  53. static const char cmd_intro_mmu_11[] PROGMEM = "G1 Z0.20 F1000.0";
  54. static const char cmd_intro_mmu_12[] PROGMEM = "G1 X5.0 E4.0 F1000.0";
  55. static const char * const intro_mmu_cmd[] PROGMEM =
  56. {
  57. cmd_intro_mmu_3,
  58. cmd_intro_mmu_4,
  59. cmd_intro_mmu_5,
  60. cmd_intro_mmu_6,
  61. cmd_intro_mmu_7,
  62. cmd_intro_mmu_8,
  63. cmd_intro_mmu_9,
  64. cmd_intro_mmu_10,
  65. cmd_intro_mmu_11,
  66. cmd_intro_mmu_12,
  67. };
  68. if (MMU2::mmu2.Enabled())
  69. {
  70. for (uint8_t i = 0; i < (sizeof(intro_mmu_cmd)/sizeof(intro_mmu_cmd[0])); ++i)
  71. {
  72. enquecommand_P(static_cast<char*>(pgm_read_ptr(&intro_mmu_cmd[i])));
  73. }
  74. }
  75. else
  76. {
  77. enquecommand_P(PSTR("G1 X60.0 E9.0 F1000.0"));
  78. enquecommand_P(PSTR("G1 X100.0 E12.5 F1000.0"));
  79. }
  80. }
  81. //! @brief Setup for printing meander
  82. void lay1cal_before_meander()
  83. {
  84. static const char cmd_pre_meander_0[] PROGMEM = "G92 E0.0";
  85. static const char cmd_pre_meander_1[] PROGMEM = "G21"; //set units to millimeters TODO unsupported command
  86. static const char cmd_pre_meander_2[] PROGMEM = "G90"; //use absolute coordinates
  87. static const char cmd_pre_meander_3[] PROGMEM = "M83"; //use relative distances for extrusion TODO: duplicate
  88. static const char cmd_pre_meander_4[] PROGMEM = "G1 E-1.50000 F2100.00000";
  89. static const char cmd_pre_meander_5[] PROGMEM = "G1 Z5 F7200.000";
  90. static const char cmd_pre_meander_6[] PROGMEM = "M204 S1000"; //set acceleration
  91. static const char cmd_pre_meander_7[] PROGMEM = "G1 F4000";
  92. static const char * const cmd_pre_meander[] PROGMEM =
  93. {
  94. cmd_pre_meander_0,
  95. cmd_pre_meander_1,
  96. cmd_pre_meander_2,
  97. cmd_pre_meander_3,
  98. cmd_pre_meander_4,
  99. cmd_pre_meander_5,
  100. cmd_pre_meander_6,
  101. cmd_pre_meander_7,
  102. };
  103. for (uint8_t i = 0; i < (sizeof(cmd_pre_meander)/sizeof(cmd_pre_meander[0])); ++i)
  104. {
  105. enquecommand_P(static_cast<char*>(pgm_read_ptr(&cmd_pre_meander[i])));
  106. }
  107. }
  108. //! @brief Count extrude length
  109. //!
  110. //! @param layer_height layer height in mm
  111. //! @param extrusion_width extrusion width in mm
  112. //! @param extrusion_length extrusion length in mm
  113. //! @return filament length in mm which needs to be extruded to form line
  114. static constexpr float count_e(float layer_height, float extrusion_width, float extrusion_length)
  115. {
  116. return (extrusion_length * layer_height * extrusion_width / (M_PI * pow(1.75, 2) / 4));
  117. }
  118. static const float width = 0.4; //!< line width
  119. static const float length = 20 - width; //!< line length
  120. static const float height = 0.2; //!< layer height TODO This is wrong, as current Z height is 0.15 mm
  121. static const float extr = count_e(height, width, length); //!< E axis movement needed to print line
  122. //! @brief Print meander
  123. //! @param cmd_buffer character buffer needed to format gcodes
  124. void lay1cal_meander(char *cmd_buffer)
  125. {
  126. static const char cmd_meander_0[] PROGMEM = "G1 X50 Y155";
  127. static const char cmd_meander_1[] PROGMEM = "G1 Z0.150 F7200.000";
  128. static const char cmd_meander_2[] PROGMEM = "G1 F1080";
  129. static const char cmd_meander_3[] PROGMEM = "G1 X75 Y155 E2.5";
  130. static const char cmd_meander_4[] PROGMEM = "G1 X100 Y155 E2";
  131. static const char cmd_meander_5[] PROGMEM = "G1 X200 Y155 E2.62773";
  132. static const char cmd_meander_6[] PROGMEM = "G1 X200 Y135 E0.66174";
  133. static const char cmd_meander_7[] PROGMEM = "G1 X50 Y135 E3.62773";
  134. static const char cmd_meander_8[] PROGMEM = "G1 X50 Y115 E0.49386";
  135. static const char cmd_meander_9[] PROGMEM = "G1 X200 Y115 E3.62773";
  136. static const char cmd_meander_10[] PROGMEM = "G1 X200 Y95 E0.49386";
  137. static const char cmd_meander_11[] PROGMEM = "G1 X50 Y95 E3.62773";
  138. static const char cmd_meander_12[] PROGMEM = "G1 X50 Y75 E0.49386";
  139. static const char cmd_meander_13[] PROGMEM = "G1 X200 Y75 E3.62773";
  140. static const char cmd_meander_14[] PROGMEM = "G1 X200 Y55 E0.49386";
  141. static const char cmd_meander_15[] PROGMEM = "G1 X50 Y55 E3.62773";
  142. static const char * const cmd_meander[] PROGMEM =
  143. {
  144. cmd_meander_0,
  145. cmd_meander_1,
  146. cmd_meander_2,
  147. cmd_meander_3,
  148. cmd_meander_4,
  149. cmd_meander_5,
  150. cmd_meander_6,
  151. cmd_meander_7,
  152. cmd_meander_8,
  153. cmd_meander_9,
  154. cmd_meander_10,
  155. cmd_meander_11,
  156. cmd_meander_12,
  157. cmd_meander_13,
  158. cmd_meander_14,
  159. cmd_meander_15,
  160. };
  161. for (uint8_t i = 0; i < (sizeof(cmd_meander)/sizeof(cmd_meander[0])); ++i)
  162. {
  163. enquecommand_P(static_cast<char*>(pgm_read_ptr(&cmd_meander[i])));
  164. }
  165. sprintf_P(cmd_buffer, PSTR("G1 X50 Y35 E%-.3f"), extr);
  166. enquecommand(cmd_buffer);
  167. }
  168. //! @brief Print square
  169. //!
  170. //! This function needs to be called 16 times for i from 0 to 15.
  171. //!
  172. //! @param cmd_buffer character buffer needed to format gcodes
  173. //! @param i iteration
  174. void lay1cal_square(char *cmd_buffer, uint8_t i)
  175. {
  176. const float extr_short_segment = count_e(height, width, width);
  177. static const char fmt1[] PROGMEM = "G1 X%d Y%-.2f E%-.3f";
  178. static const char fmt2[] PROGMEM = "G1 Y%-.2f E%-.3f";
  179. sprintf_P(cmd_buffer, fmt1, 70, (35 - i*width * 2), extr);
  180. enquecommand(cmd_buffer);
  181. sprintf_P(cmd_buffer, fmt2, (35 - (2 * i + 1)*width), extr_short_segment);
  182. enquecommand(cmd_buffer);
  183. sprintf_P(cmd_buffer, fmt1, 50, (35 - (2 * i + 1)*width), extr);
  184. enquecommand(cmd_buffer);
  185. sprintf_P(cmd_buffer, fmt2, (35 - (i + 1)*width * 2), extr_short_segment);
  186. enquecommand(cmd_buffer);
  187. }