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     issue_change_speed= false;
  48 }
  49
  50 void WatchScreen::on_enter(){
  51     this->panel->lcd->clear();
  52     this->panel->setup_menu(4);
  53     get_temp_data();
  54     get_current_pos(this->pos);
  55     get_sd_play_info();
  56     this->current_speed= lround(get_current_speed());
  57     this->refresh_screen(false);
  58     this->panel->enter_control_mode(1,0.5);
  59     this->panel->set_control_value(this->current_speed);
  60 }
  61
  62 void WatchScreen::on_refresh(){
  63     // Exit if the button is clicked
  64     if( this->panel->click() ){
  65         this->panel->enter_screen(this->parent);
  66         return;
  67     }
  68
  69     // see if speed is being changed
  70     if(this->panel->control_value_change()) {
  71         this->current_speed= this->panel->get_control_value();
  72         if(this->current_speed < 10) {
  73             this->current_speed= 10;
  74             this->panel->set_control_value(this->current_speed);
  75             this->panel->reset_counter();
  76         }else{
  77             // flag the update to change the speed, we don't want to issue hundreds of M220s
  78             // but we do want to display the change we are going to make
  79             this->speed_changed= true; // flag indicating speed changed
  80             this->refresh_screen(false);
  81         }
  82     }
  83
  84     // Update Only every 20 refreshes, 1 a second
  85     static int update_counts = 0;
  86     update_counts++;
  87     if( update_counts % 20 == 0 ){
  88         get_sd_play_info();
  89         get_current_pos(this->pos);
  90         get_temp_data();
  91         if(this->speed_changed) {
  92             this->issue_change_speed= true; // trigger actual command to change speed
  93             this->speed_changed= false;
  94         }else if(!this->issue_change_speed){ // change still queued
  95             // read it in case it was changed via M220
  96             this->current_speed= lround(get_current_speed());
  97             this->panel->set_control_value(this->current_speed);
  98             this->panel->reset_counter();
  99         }
 100
 101         this->refresh_screen(this->panel->lcd->hasGraphics()?true:false); // graphics screens should be cleared
 102
 103         // for LCDs with leds set them according to heater status
 104         // TODO should be enabled and disabled and settable from config
 105         this->panel->lcd->setLed(LED_BED_ON, this->bedtarget > 0);
 106         this->panel->lcd->setLed(LED_HOTEND_ON, this->hotendtarget > 0);
 107         //this->panel->lcd->setLed(LED_FAN_ON, this->fanon);
 108
 109         if(this->panel->lcd->hasGraphics()) {
 110             // display the graphical icons below the status are
 111             //this->panel->lcd->bltGlyph(0, 34, 115, 19, icons);
 112             // for (int i = 0; i < 5; ++i) {
 113             //     this->panel->lcd->bltGlyph(i*24, 38, 23, 19, icons, 15, i*24, 0);
 114             // }
 115             if(this->hotendtarget > 0)
 116                 this->panel->lcd->bltGlyph(8, 38, 20, 19, icons, 15, 0, 0);
 117
 118             if(this->bedtarget > 0)
 119                 this->panel->lcd->bltGlyph(32, 38, 23, 19, icons, 15, 64, 0);
 120
 121             // fan appears always on for now
 122             this->panel->lcd->bltGlyph(96, 38, 23, 19, icons, 15, 96, 0);
 123         }
 124     }
 125 }
 126
 127 // queuing gcodes needs to be done from main loop
 128 void WatchScreen::on_main_loop() {
 129     if(this->issue_change_speed) {
 130         this->issue_change_speed= false;
 131         set_speed();
 132     }
 133     //time_idle();
 134 }
 135
 136 // fetch the data we are displaying
 137 void WatchScreen::get_temp_data() {
 138     void *returned_data;
 139     bool ok;
 140
 141     ok= THEKERNEL->public_data->get_value( temperature_control_checksum, bed_checksum, current_temperature_checksum, &returned_data );
 142     if(ok) {
 143         struct pad_temperature temp=  *static_cast<struct pad_temperature*>(returned_data);
 144         this->bedtemp= round(temp.current_temperature);
 145         if(this->bedtemp > 100000) this->bedtemp = -2;
 146         this->bedtarget= round(temp.target_temperature);
 147         //this->bedpwm= temp.pwm;
 148     }else{
 149         // temp probably disabled
 150         this->bedtemp= -1;
 151         this->bedtarget= -1;
 152     }
 153
 154     ok= THEKERNEL->public_data->get_value( temperature_control_checksum, hotend_checksum, current_temperature_checksum, &returned_data );
 155     if(ok) {
 156         struct pad_temperature temp=  *static_cast<struct pad_temperature*>(returned_data);
 157         this->hotendtemp= round(temp.current_temperature);
 158         if(this->hotendtemp > 100000) this->hotendtemp = -2;
 159         this->hotendtarget= round(temp.target_temperature);
 160         //this->hotendpwm= temp.pwm;
 161     }else{
 162         // temp probably disabled
 163         this->hotendtemp= -1;
 164         this->hotendtarget= -1;
 165     }
 166 }
 167
 168 // fetch the data we are displaying
 169 double WatchScreen::get_current_speed() {
 170     void *returned_data;
 171
 172     bool ok= THEKERNEL->public_data->get_value( robot_checksum, speed_override_percent_checksum, &returned_data );
 173     if(ok) {
 174         double cs= *static_cast<double *>(returned_data);
 175         return cs;
 176     }
 177     return 0.0;
 178 }
 179
 180 void WatchScreen::get_current_pos(double *cp){
 181     void *returned_data;
 182
 183     bool ok= THEKERNEL->public_data->get_value( robot_checksum, current_position_checksum, &returned_data );
 184     if(ok) {
 185         double *p= static_cast<double *>(returned_data);
 186         cp[0]= p[0];
 187         cp[1]= p[1];
 188         cp[2]= p[2];
 189     }
 190 }
 191
 192 void WatchScreen::get_sd_play_info(){
 193     void *returned_data;
 194     bool ok= THEKERNEL->public_data->get_value( player_checksum, get_progress_checksum, &returned_data );
 195     if(ok) {
 196         struct pad_progress p=  *static_cast<struct pad_progress*>(returned_data);
 197         this->elapsed_time= p.elapsed_secs;
 198         this->sd_pcnt_played= p.percent_complete;
 199     }else{
 200         this->elapsed_time= 0;
 201         this->sd_pcnt_played= 0;
 202     }
 203 }
 204
 205 void WatchScreen::display_menu_line(uint16_t line){
 206     // in menu mode
 207     switch( line ){
 208         case 0: this->panel->lcd->printf("H%03d/%03dc B%03d/%03dc", this->hotendtemp, this->hotendtarget, this->bedtemp, this->bedtarget); break;
 209         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;
 210         case 2: this->panel->lcd->printf("%3d%% %2d:%02d %3d%% sd", this->current_speed, this->elapsed_time/60, this->elapsed_time%60, this->sd_pcnt_played); break;
 211         case 3: this->panel->lcd->printf("%19s", this->get_status()); break;
 212     }
 213 }
 214
 215 const char* WatchScreen::get_status(){
 216     if(panel->hasMessage()) {
 217         return panel->getMessage().c_str();
 218     }
 219
 220     if(THEKERNEL->pauser->paused())
 221         return "Paused";
 222
 223     if(panel->is_playing())
 224         return panel->get_playing_file();
 225
 226     return "Smoothie ready";
 227 }
 228
 229 void WatchScreen::set_speed(){
 230     // change pos by issuing a M220 Snnn
 231     char buf[32];
 232     int n= snprintf(buf, sizeof(buf), "M220 S%d", this->current_speed);
 233     string g(buf, n);
 234     send_gcode(g);
 235 }