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