first_lay_cal.cpp 7.5 KB

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