2 This file is part of Smoothie (http://smoothieware.org/). The motion control part is heavily based on Grbl (https://github.com/simen/grbl).
3 Smoothie is free software: you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation, either version 3 of the License, or (at your option) any later version.
4 Smoothie is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details.
5 You should have received a copy of the GNU General Public License along with Smoothie. If not, see <http://www.gnu.org/licenses/>.
8 #include "libs/Kernel.h"
10 #include "PanelScreen.h"
11 #include "MainMenuScreen.h"
12 #include "WatchScreen.h"
13 #include "libs/nuts_bolts.h"
14 #include "libs/utils.h"
15 #include "modules/tools/temperaturecontrol/TemperatureControlPublicAccess.h"
16 #include "modules/robot/RobotPublicAccess.h"
17 #include "modules/utils/player/PlayerPublicAccess.h"
21 static const uint8_t icons
[] = { // 115x19 - 3 bytes each: he1, he2, he3, bed, fan
22 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x7F,0xFF,0xE0,
23 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x70,0x00,0xE0,
24 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x63,0x0C,0x60,
25 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x47,0x0E,0x20,
26 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x4F,0x0F,0x20,
27 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x5F,0x0F,0xA0,
28 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x5E,0x07,0xA0,
29 0x7F,0x80,0x00,0x3F,0xC0,0x00,0x3F,0xC0,0x00,0x41,0x04,0x00,0x40,0x60,0x20,
30 0xFB,0xC0,0x00,0x79,0xE0,0x00,0x79,0xE0,0x00,0x20,0x82,0x00,0x40,0xF0,0x20,
31 0xF3,0xC0,0x00,0x76,0xE0,0x00,0x76,0xE0,0x00,0x20,0x82,0x00,0x40,0xF0,0x20,
32 0xEB,0xC0,0x00,0x7E,0xE0,0x00,0x7E,0xE0,0x00,0x41,0x04,0x00,0x40,0x60,0x20,
33 0x7B,0x80,0x00,0x3D,0xC0,0x00,0x39,0xC0,0x00,0x82,0x08,0x00,0x5E,0x07,0xA0,
34 0x7B,0x80,0x00,0x3B,0xC0,0x00,0x3E,0xC0,0x01,0x04,0x10,0x00,0x5F,0x0F,0xA0,
35 0xFB,0xC0,0x00,0x77,0xE0,0x00,0x76,0xE0,0x01,0x04,0x10,0x00,0x4F,0x0F,0x20,
36 0xFB,0xC0,0x00,0x70,0xE0,0x00,0x79,0xE0,0x00,0x82,0x08,0x00,0x47,0x0E,0x20,
37 0xFF,0xC0,0x00,0x7F,0xE0,0x00,0x7F,0xE0,0x00,0x41,0x04,0x00,0x63,0x0C,0x60,
38 0x3F,0x00,0x00,0x1F,0x80,0x00,0x1F,0x80,0x00,0x00,0x00,0x00,0x70,0x00,0xE0,
39 0x1E,0x00,0x00,0x0F,0x00,0x00,0x0F,0x00,0x01,0xFF,0xFF,0x80,0x7F,0xFF,0xE0,
40 0x0C,0x00,0x00,0x06,0x00,0x00,0x06,0x00,0x01,0xFF,0xFF,0x80,0x00,0x00,0x00
45 WatchScreen::WatchScreen(){
49 void WatchScreen::on_enter(){
50 this->panel
->lcd
->clear();
51 this->panel
->setup_menu(4);
53 get_current_pos(this->pos
);
55 this->current_speed
= get_current_speed();
56 this->refresh_screen(false);
57 this->panel
->enter_control_mode(1,0.5);
58 this->panel
->set_control_value(this->current_speed
);
61 void WatchScreen::on_refresh(){
62 // Exit if the button is clicked
63 if( this->panel
->click() ){
64 this->panel
->enter_screen(this->parent
);
68 // see if speed is being changed
69 if(this->panel
->control_value_change()) {
70 this->current_speed
= this->panel
->get_control_value();
71 if(this->current_speed
< 1.0) {
72 this->current_speed
= 1.0;
73 this->panel
->set_control_value(this->current_speed
);
74 this->panel
->reset_counter();
76 // change actual speed
77 this->speed_changed
= true; // flag main loop to issue g code
78 this->refresh_screen(false);
82 // Update Only every 20 refreshes, 1 a second
83 static int update_counts
= 0;
85 if( update_counts
% 20 == 0 ){
87 get_current_pos(this->pos
);
89 this->current_speed
= get_current_speed();
90 this->panel
->set_control_value(this->current_speed
); // in case it was changed via M220
91 this->panel
->reset_counter();
93 this->refresh_screen(false);
95 // for LCDs with leds set them according to heater status
96 // TODO should be enabled and disabled and settable from config
97 this->panel
->lcd
->setLed(LED_BED_ON
, this->bedtarget
> 0);
98 this->panel
->lcd
->setLed(LED_HOTEND_ON
, this->hotendtarget
> 0);
99 //this->panel->lcd->setLed(LED_FAN_ON, this->fanon);
101 if(this->panel
->lcd
->hasGraphics()) {
102 // display the graphical icons below the status are
103 //this->panel->lcd->bltGlyph(0, 34, 115, 19, icons);
104 // for (int i = 0; i < 5; ++i) {
105 // this->panel->lcd->bltGlyph(i*24, 38, 23, 19, icons, 15, i*24, 0);
107 if(this->hotendtarget
> 0)
108 this->panel
->lcd
->bltGlyph(8, 38, 20, 19, icons
, 15, 0, 0);
110 if(this->bedtarget
> 0)
111 this->panel
->lcd
->bltGlyph(32, 38, 23, 19, icons
, 15, 64, 0);
113 // fan always on for now
114 this->panel
->lcd
->bltGlyph(96, 38, 23, 19, icons
, 15, 96, 0);
119 // queuing gcodes needs to be done from main loop
120 void WatchScreen::on_main_loop() {
121 if(!this->speed_changed
) return;
122 this->speed_changed
= false;
126 // fetch the data we are displaying
127 void WatchScreen::get_temp_data() {
131 ok
= THEKERNEL
->public_data
->get_value( temperature_control_checksum
, bed_checksum
, current_temperature_checksum
, &returned_data
);
133 struct pad_temperature temp
= *static_cast<struct pad_temperature
*>(returned_data
);
134 this->bedtemp
= round(temp
.current_temperature
);
135 if(this->bedtemp
> 100000) this->bedtemp
= -2;
136 this->bedtarget
= round(temp
.target_temperature
);
137 //this->bedpwm= temp.pwm;
139 // temp probably disabled
144 ok
= THEKERNEL
->public_data
->get_value( temperature_control_checksum
, hotend_checksum
, current_temperature_checksum
, &returned_data
);
146 struct pad_temperature temp
= *static_cast<struct pad_temperature
*>(returned_data
);
147 this->hotendtemp
= round(temp
.current_temperature
);
148 if(this->hotendtemp
> 100000) this->hotendtemp
= -2;
149 this->hotendtarget
= round(temp
.target_temperature
);
150 //this->hotendpwm= temp.pwm;
152 // temp probably disabled
153 this->hotendtemp
= -1;
154 this->hotendtarget
= -1;
158 // fetch the data we are displaying
159 double WatchScreen::get_current_speed() {
162 bool ok
= THEKERNEL
->public_data
->get_value( robot_checksum
, speed_override_percent_checksum
, &returned_data
);
164 double cs
= *static_cast<double *>(returned_data
);
170 void WatchScreen::get_current_pos(double *cp
){
173 bool ok
= THEKERNEL
->public_data
->get_value( robot_checksum
, current_position_checksum
, &returned_data
);
175 double *p
= static_cast<double *>(returned_data
);
182 void WatchScreen::get_sd_play_info(){
184 bool ok
= THEKERNEL
->public_data
->get_value( player_checksum
, get_progress_checksum
, &returned_data
);
186 struct pad_progress p
= *static_cast<struct pad_progress
*>(returned_data
);
187 this->elapsed_time
= p
.elapsed_secs
;
188 this->sd_pcnt_played
= p
.percent_complete
;
190 this->elapsed_time
= 0;
191 this->sd_pcnt_played
= 0;
195 void WatchScreen::display_menu_line(uint16_t line
){
198 case 0: this->panel
->lcd
->printf("H%03d/%03dc B%03d/%03dc", this->hotendtemp
, this->hotendtarget
, this->bedtemp
, this->bedtarget
); break;
199 case 1: this->panel
->lcd
->printf("X%4d Y%4d Z%7.2f", (int)round(this->pos
[0]), (int)round(this->pos
[1]), this->pos
[2]); break;
200 case 2: this->panel
->lcd
->printf("%3d%% %2d:%02d %3d%% sd", (int)round(this->current_speed
), this->elapsed_time
/60, this->elapsed_time
%60, this->sd_pcnt_played
); break;
201 case 3: this->panel
->lcd
->printf("%19s", this->get_status()); break;
205 const char* WatchScreen::get_status(){
206 if(THEKERNEL
->pauser
->paused())
209 if(panel
->is_playing())
210 return panel
->get_playing_file();
212 return "Smoothie ready";
215 void WatchScreen::set_speed(){
216 // change pos by issuing a M220 Snnn
218 int n
= snprintf(buf
, sizeof(buf
), "M220 S%f", this->current_speed
);