src/modules/utils/panel/screens/WatchScreen.cpp

   1 /*
   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/>.
   6 */
   7
   8 #include "libs/Kernel.h"
   9 #include "Panel.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"
  18
  19 #include <string>
  20 using namespace std;
  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
  41 };
  42
  43
  44
  45 WatchScreen::WatchScreen(){
  46     speed_changed= false;
  47 }
  48
  49 void WatchScreen::on_enter(){
  50     this->panel->lcd->clear();
  51     this->panel->setup_menu(4);
  52     get_temp_data();
  53     get_current_pos(this->pos);
  54     get_sd_play_info();
  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);
  59 }
  60
  61 void WatchScreen::on_refresh(){
  62     // Exit if the button is clicked
  63     if( this->panel->click() ){
  64         this->panel->enter_screen(this->parent);
  65         return;
  66     }
  67
  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 < 10.0) {
  72             this->current_speed= 10.0;
  73             this->panel->set_control_value(this->current_speed);
  74             this->panel->reset_counter();
  75         }else{
  76             // change actual speed
  77             this->speed_changed= true; // flag main loop to issue g code
  78             this->refresh_screen(false);
  79         }
  80     }
  81
  82     // Update Only every 20 refreshes, 1 a second
  83     static int update_counts = 0;
  84     update_counts++;
  85     if( update_counts % 20 == 0 ){
  86         get_sd_play_info();
  87         get_current_pos(this->pos);
  88         get_temp_data();
  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();
  92
  93         this->refresh_screen(false);
  94
  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);
 100
 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);
 106             // }
 107             if(this->hotendtarget > 0)
 108                 this->panel->lcd->bltGlyph(8, 38, 20, 19, icons, 15, 0, 0);
 109
 110             if(this->bedtarget > 0)
 111                 this->panel->lcd->bltGlyph(32, 38, 23, 19, icons, 15, 64, 0);
 112
 113             // fan appears always on for now
 114             this->panel->lcd->bltGlyph(96, 38, 23, 19, icons, 15, 96, 0);
 115         }
 116     }
 117 }
 118
 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;
 123     set_speed();
 124 }
 125
 126 // fetch the data we are displaying
 127 void WatchScreen::get_temp_data() {
 128     void *returned_data;
 129     bool ok;
 130
 131     ok= THEKERNEL->public_data->get_value( temperature_control_checksum, bed_checksum, current_temperature_checksum, &returned_data );
 132     if(ok) {
 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;
 138     }else{
 139         // temp probably disabled
 140         this->bedtemp= -1;
 141         this->bedtarget= -1;
 142     }
 143
 144     ok= THEKERNEL->public_data->get_value( temperature_control_checksum, hotend_checksum, current_temperature_checksum, &returned_data );
 145     if(ok) {
 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;
 151     }else{
 152         // temp probably disabled
 153         this->hotendtemp= -1;
 154         this->hotendtarget= -1;
 155     }
 156 }
 157
 158 // fetch the data we are displaying
 159 double WatchScreen::get_current_speed() {
 160     void *returned_data;
 161
 162     bool ok= THEKERNEL->public_data->get_value( robot_checksum, speed_override_percent_checksum, &returned_data );
 163     if(ok) {
 164         double cs= *static_cast<double *>(returned_data);
 165         return cs;
 166     }
 167     return 0.0;
 168 }
 169
 170 void WatchScreen::get_current_pos(double *cp){
 171     void *returned_data;
 172
 173     bool ok= THEKERNEL->public_data->get_value( robot_checksum, current_position_checksum, &returned_data );
 174     if(ok) {
 175         double *p= static_cast<double *>(returned_data);
 176         cp[0]= p[0];
 177         cp[1]= p[1];
 178         cp[2]= p[2];
 179     }
 180 }
 181
 182 void WatchScreen::get_sd_play_info(){
 183     void *returned_data;
 184     bool ok= THEKERNEL->public_data->get_value( player_checksum, get_progress_checksum, &returned_data );
 185     if(ok) {
 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;
 189     }else{
 190         this->elapsed_time= 0;
 191         this->sd_pcnt_played= 0;
 192     }
 193 }
 194
 195 void WatchScreen::display_menu_line(uint16_t line){
 196     // in menu mode
 197     switch( 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;
 202     }
 203 }
 204
 205 const char* WatchScreen::get_status(){
 206     if(THEKERNEL->pauser->paused())
 207         return "Paused";
 208
 209     if(panel->is_playing())
 210         return panel->get_playing_file();
 211
 212     return "Smoothie ready";
 213 }
 214
 215 void WatchScreen::set_speed(){
 216     // change pos by issuing a M220 Snnn
 217     char buf[32];
 218     int n= snprintf(buf, sizeof(buf), "M220 S%f", this->current_speed);
 219     string g(buf, n);
 220     send_gcode(g);
 221 }