A web server for monitoring and controlling a MakerBot Replicator over the USB host and ethernet.

Dependencies:   IAP NTPClient RTC mbed-rtos mbed Socket lwip-sys lwip BurstSPI

Fork of LPC1768_Mini-DK by Frank Vannieuwkerke

Makerbot Server for LPC1768 Copyright (c) 2013, jake (at) allaboutjake (dot) com 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.
  • The name of the author and/or copyright holder 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, AUTHOR, OR ANY 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.

Warnings:

This is not a commercial product or a hardened and secure network appliance. It is intended as a thought experiment or proof of concept and should not be relied upon in any way. Always operate your 3D printer in a safe and controlled manner.

Do not connect this directly to the exposed internet. It is intended to be behind a secure firewall (and NAT) such that it will only accept commands from the local network. Imagine how much fun a hacker could have instructing your 3D printer to continually print Standford bunnies. Well it could be much worse then that- a malicious user could send commands that could crash your machine (both in the software sense, as well as in the "smash your moving parts against the side of the machine repeatedly sense), overheat your extruders, cause your build plate to catch fire, and do severe damage to the machine, any surrounding building and propery. You have been warned.

Never print unattended and be ready to step in and stop the machine if something goes wrong. Keep in mind, a 3D printer has heaters that are operating at high temperatures, and if something starts to burn, it could cause damage to the machine, other property, and/or hurt yourself, pets, or others.

You should understand what you are doing. The source code here is not intended as a finished product or set of step by step instructions. You should engineer your own solution, which may wind up being better than mine.

Proceed at your own risk. You've been warned. (Several times) If you break your Makerbot, burn your house down, or injure yourself or others, I take no responsibility.

Introduction

I've been working on a side project to solve the "last mile" problem for people wanting to print from the network on their bots. I feel like the first half of the problem is solved with the FlashAir- getting the files to the card. The next step is a lightweight way of sending the "play back capture" command to the bot.

I looked around for a microcontroller platform that supports both networking and can function as a USB host. I happened to have an mbed (mbed) on hand that fit the bill. The mbed also has a working online toolchain (you need to own an mbed to gain access to the compiler). Some people don't like the online development environment, but I'm a fan of "working" and "Mac compatible." It was a good start, but cost wise, you would need an mbed LPC1768 module and some sort of carrier board that has both USB host and ethernet, or rig up your own connector solution. I happened to also have a Seedstudio mbed shield carrier board. This provides ethernet and USB connectors, but is another $25, putting the solution at around $75.

I also had an LPC1768 development board here called the "Mini-DK2". It has a USB host and a wired ethernet connector on board (search ebay if you're interested). It's a single-board solution that costs only $32 (and for $40 you can get one with a touchscreen) Its the cheapest development board I've seen with both USB host and an ethernet connector. I considered RasPi, but I'm not on that bandwagon. Since I had the Mini-DK2 on hand from another project that never went anywhere, I moved from the mbed module and carrier board to the DK2.

The mbed environment can compile binaries that work on the DK2 (again, you need to own at least one 1768 mbed already to get a license to use the compiler), and the mbed libraries provide some nice features. A USB Host library and and Ethernet library were readily available. The USBHost library didn't quite work out of the box. It took some time and more learning about the USB protocols than I would have liked, but I have the board communicating over the USB Host and the Makerbot.

Changes to stock mbed libraries

Many libraries are imported, but then converted to folders as to unlink them.

mbed provides a USHost library that includes a USBHostSerial object for connecting to CDC serial devices. Unfortunately, it did not work for me out of the box. I spent some time learning about USB protocols. One good reference is [Jan Axelson's Lakeview Research](http://www.lvr.com/usb_virtual_com_port.htm) discussion about CDC.

I found that the stock library was sending the control transfers to Interface 1. From what I understand, the control transfers needed to go to interface 0. I modified the USBHostSerial library to correct this, and the serial port interface came to life.

Next, I found that I wasn't able to get reliable communication. I traced it to what I think is an odd C++ inheritance and override problem. The USBHostSerial class implements the Stream interface, allowing printf/scanf operations. This is done by overriding the virtual _getc and _putc methods. Unfortunately, and for a reason I can't understand, these methods were not being called consistently. Sometimes they would work, but other times they would not. My solution was to implement transmit/receive methods with different names, and since the names were different, they seemed to get called consistently. I'd like to learn exactly what's going on here, but I don't feel like debugging it for academic purposes when it works just fine with the added methods.

Usage

Connect up your chosen dev board to power, ethernet and the USB host to the Makerbot's USB cable. The Mini-DK uses a USB-OTG adapter for the USB host. If you're using a Mini-DK board with an LCD, it will inform you of it's IP address on the display. This means it is now listening for a connection on port 7654.

If you are using an mbed dev board, or a Mini-DK without a display, the message will be directed to the serial console. Connect your computer to the appropriate port at a baud rate of 115200 to see the messages.

Use a telnet client to connect to the given IP address at port 7654. Telnet clients typically revert to "line mode" on ports other than 21. This means you get a local echo and the command isn't sent until you press enter.

Once connected, you can send the following commands:

A <username>:<password> : Set a username & password for the web interface and the telnet interface. Use the format shown with a colon separating the username from the password.

V : Print the version and Makerbot name, as well as the local firmware version (the Makerbot_Server firmware as discussed here).

B <filename.x3g> : Build from SD the given filename. According tot he protocol spec, this command is limited to 12 characters, so 8.3 filenames only.

P : Pause an active build

R : Resume active build

C : Cancel build- note that this immediately halts the build and does not clear the build area. You might want to pause the build first, and then cancel shortly after to make sure the nozzle isn't left hot and in contact with a printed part.

S : Print build status, tool and platform temps

Q : Quit and logout

The Mini-DK has two onboard buttons (besides the ISP and reset buttons). Currently one button will trigger a pause (if the Makerbot is printing) and the other will resume (if the Makerbot it paused)

Compiling

Edit "Target.h" to set whether you're building for an MBED module or the Mini-DK2

Installation

If you are using a mbed, then you can simply load the BIN file to the mbed using the mass storage bootloader. The mbed mounts as if it were a USB thumbdrive, and you copy the BIN file to the drive. After a reset, you're running the installed firmware.

The MiniDK has a serial bootloader. You connect to this bootloader from the "top" USB connector (not the USB host one). Hold down the ISP button and then tap the reset button and then release the ISP button to put it into programming mode. I use [lpc21isp](http://sourceforge.net/projects/lpc21isp/) to load the binary. The other option is FlashMagic, which uses HEX files, so you'll need to use some sort of bin2hex utility to convert the firmware file if you use this utility. I can't really say if/how this works, as I don't use this method. See this (http://mbed.org/users/frankvnk/notebook/lpc1768-mini-dk/) for more info.

Credits

Some credits, where credit is due.

EthernetInterface - modified to include PHY code for both the MiniDK2 and MBED based on selected #definitions

Mini-DK - Thanks for Frank and Erik for doing all the heavy lifting getting the MBED compiler and libraries and peripherals working on the Mini-DK2

NTP Client - Thanks to Donatien for this library to set the clock over the network

RTC - Thanks to Erik for the RTC library. I've got it in my project, but I don't think I'm using it for anything (yet).

SimpleSocket - Thanks to Yamaguchi-san. Modified slightly to take out references to EthernetInterface::init() and ::getIPAddress(). For some reason these don't like to be called in a thread.

JPEGCamera - Thanks again to Yamaguchi-san. Modified to output the JPEG binary over a socket rather than to a file descriptor.

USBHost - modified as noted above

IAP - Thanks to Okano-san. Pulled out of the Mini-DK folder so that I could link it back to the base repository at the root level.

Committer:
jakeb
Date:
Fri Aug 23 21:45:08 2013 +0000
Revision:
15:688b3e3958fd
Initial commit of software v0.2;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jakeb 15:688b3e3958fd 1 /**************************************************************************************************
jakeb 15:688b3e3958fd 2 ***** *****
jakeb 15:688b3e3958fd 3 ***** Name: Touch.cpp *****
jakeb 15:688b3e3958fd 4 ***** Ver.: 1.0 *****
jakeb 15:688b3e3958fd 5 ***** Date: 04/01/2013 *****
jakeb 15:688b3e3958fd 6 ***** Auth: Frank Vannieuwkerke *****
jakeb 15:688b3e3958fd 7 ***** Erik Olieman *****
jakeb 15:688b3e3958fd 8 ***** Func: Touch driver for use with ADS7843 *****
jakeb 15:688b3e3958fd 9 ***** *****
jakeb 15:688b3e3958fd 10 ***** Code based on Carlos E. Vidales tutorial : *****
jakeb 15:688b3e3958fd 11 ***** How To Calibrate Touch Screens *****
jakeb 15:688b3e3958fd 12 ***** www.embedded.com/design/configurable-systems/4023968/How-To-Calibrate-Touch-Screens *****
jakeb 15:688b3e3958fd 13 ***** *****
jakeb 15:688b3e3958fd 14 **************************************************************************************************/
jakeb 15:688b3e3958fd 15
jakeb 15:688b3e3958fd 16 #include "Touch.h"
jakeb 15:688b3e3958fd 17 #include "mbed.h"
jakeb 15:688b3e3958fd 18 #include "Arial12x12.h"
jakeb 15:688b3e3958fd 19
jakeb 15:688b3e3958fd 20 #define THRESHOLD 2
jakeb 15:688b3e3958fd 21
jakeb 15:688b3e3958fd 22 TouchScreenADS7843::TouchScreenADS7843(PinName tp_mosi, PinName tp_miso, PinName tp_sclk, PinName tp_cs, PinName tp_irq, SPI_TFT *_LCD)
jakeb 15:688b3e3958fd 23 : LCD(_LCD), _tp_spi(tp_mosi, tp_miso, tp_sclk), _tp_cs(tp_cs), _tp_irq(tp_irq)
jakeb 15:688b3e3958fd 24 {
jakeb 15:688b3e3958fd 25 DisplaySample[0].x=45;
jakeb 15:688b3e3958fd 26 DisplaySample[0].y=45;
jakeb 15:688b3e3958fd 27 DisplaySample[1].x=45;
jakeb 15:688b3e3958fd 28 DisplaySample[1].y=270;
jakeb 15:688b3e3958fd 29 DisplaySample[2].x=190;
jakeb 15:688b3e3958fd 30 DisplaySample[2].y=190;
jakeb 15:688b3e3958fd 31 ScreenSample[0].x=45;
jakeb 15:688b3e3958fd 32 ScreenSample[0].y=45;
jakeb 15:688b3e3958fd 33 ScreenSample[1].x=45;
jakeb 15:688b3e3958fd 34 ScreenSample[1].y=270;
jakeb 15:688b3e3958fd 35 ScreenSample[2].x=190;
jakeb 15:688b3e3958fd 36 ScreenSample[2].y=190;
jakeb 15:688b3e3958fd 37 _tp_cs=1;
jakeb 15:688b3e3958fd 38 _tp_spi.frequency(500000);
jakeb 15:688b3e3958fd 39 _tp_spi.format(8,0); // 8 bit spi mode 0
jakeb 15:688b3e3958fd 40 }
jakeb 15:688b3e3958fd 41
jakeb 15:688b3e3958fd 42 int TouchScreenADS7843::Read_XY(unsigned char XY)
jakeb 15:688b3e3958fd 43 {
jakeb 15:688b3e3958fd 44 unsigned char msb, lsb;
jakeb 15:688b3e3958fd 45 unsigned int Temp;
jakeb 15:688b3e3958fd 46
jakeb 15:688b3e3958fd 47 Temp=0;
jakeb 15:688b3e3958fd 48 _tp_cs=0;
jakeb 15:688b3e3958fd 49 wait_us(SPI_RD_DELAY);
jakeb 15:688b3e3958fd 50 _tp_spi.write(XY);
jakeb 15:688b3e3958fd 51 wait_us(SPI_RD_DELAY);
jakeb 15:688b3e3958fd 52 msb = _tp_spi.write(0x00); // msb
jakeb 15:688b3e3958fd 53 wait_us(SPI_RD_DELAY);
jakeb 15:688b3e3958fd 54 lsb = _tp_spi.write(0x00); // lsb
jakeb 15:688b3e3958fd 55 _tp_cs=1;
jakeb 15:688b3e3958fd 56 Temp = ((msb << 8 ) | lsb);
jakeb 15:688b3e3958fd 57 Temp >>= 3;
jakeb 15:688b3e3958fd 58 Temp &= 0xfff;
jakeb 15:688b3e3958fd 59 Temp /= 4; // Scaling : return value range must be between 0 and 1024
jakeb 15:688b3e3958fd 60 return(Temp);
jakeb 15:688b3e3958fd 61 }
jakeb 15:688b3e3958fd 62
jakeb 15:688b3e3958fd 63
jakeb 15:688b3e3958fd 64 void TouchScreenADS7843::TP_GetAdXY(int *x,int *y)
jakeb 15:688b3e3958fd 65 {
jakeb 15:688b3e3958fd 66 int adx,ady;
jakeb 15:688b3e3958fd 67 adx = Read_XY(CHX);
jakeb 15:688b3e3958fd 68 wait_us(1);
jakeb 15:688b3e3958fd 69 ady = Read_XY(CHY);
jakeb 15:688b3e3958fd 70 *x = adx;
jakeb 15:688b3e3958fd 71 *y = ady;
jakeb 15:688b3e3958fd 72 }
jakeb 15:688b3e3958fd 73
jakeb 15:688b3e3958fd 74 void TouchScreenADS7843::TP_DrawPoint(unsigned int Xpos,unsigned int Ypos, unsigned int color)
jakeb 15:688b3e3958fd 75 {
jakeb 15:688b3e3958fd 76 LCD->wr_reg(0x03, 0x1030);
jakeb 15:688b3e3958fd 77 LCD->WindowMax();
jakeb 15:688b3e3958fd 78 LCD->pixel(Xpos,Ypos,color);
jakeb 15:688b3e3958fd 79 LCD->pixel(Xpos+1,Ypos,color);
jakeb 15:688b3e3958fd 80 LCD->pixel(Xpos,Ypos+1,color);
jakeb 15:688b3e3958fd 81 LCD->pixel(Xpos+1,Ypos+1,color);
jakeb 15:688b3e3958fd 82 }
jakeb 15:688b3e3958fd 83
jakeb 15:688b3e3958fd 84 void TouchScreenADS7843::DrawCross(unsigned int Xpos,unsigned int Ypos)
jakeb 15:688b3e3958fd 85 {
jakeb 15:688b3e3958fd 86 LCD->line(Xpos-15,Ypos,Xpos-2,Ypos,White);
jakeb 15:688b3e3958fd 87 LCD->line(Xpos+2,Ypos,Xpos+15,Ypos,White);
jakeb 15:688b3e3958fd 88 LCD->line(Xpos,Ypos-15,Xpos,Ypos-2,White);
jakeb 15:688b3e3958fd 89 LCD->line(Xpos,Ypos+2,Xpos,Ypos+15,White);
jakeb 15:688b3e3958fd 90
jakeb 15:688b3e3958fd 91 LCD->line(Xpos-15,Ypos+15,Xpos-7,Ypos+15,DarkGrey);
jakeb 15:688b3e3958fd 92 LCD->line(Xpos-15,Ypos+7,Xpos-15,Ypos+15,DarkGrey);
jakeb 15:688b3e3958fd 93
jakeb 15:688b3e3958fd 94 LCD->line(Xpos-15,Ypos-15,Xpos-7,Ypos-15,DarkGrey);
jakeb 15:688b3e3958fd 95 LCD->line(Xpos-15,Ypos-7,Xpos-15,Ypos-15,DarkGrey);
jakeb 15:688b3e3958fd 96
jakeb 15:688b3e3958fd 97 LCD->line(Xpos+7,Ypos+15,Xpos+15,Ypos+15,DarkGrey);
jakeb 15:688b3e3958fd 98 LCD->line(Xpos+15,Ypos+7,Xpos+15,Ypos+15,DarkGrey);
jakeb 15:688b3e3958fd 99
jakeb 15:688b3e3958fd 100 LCD->line(Xpos+7,Ypos-15,Xpos+15,Ypos-15,DarkGrey);
jakeb 15:688b3e3958fd 101 LCD->line(Xpos+15,Ypos-15,Xpos+15,Ypos-7,DarkGrey);
jakeb 15:688b3e3958fd 102 }
jakeb 15:688b3e3958fd 103
jakeb 15:688b3e3958fd 104 unsigned char TouchScreenADS7843::Read_Ads7846(Coordinate * screenPtr)
jakeb 15:688b3e3958fd 105 {
jakeb 15:688b3e3958fd 106 int m0,m1,m2,TP_X[1],TP_Y[1],temp[3];
jakeb 15:688b3e3958fd 107 uint8_t count=0;
jakeb 15:688b3e3958fd 108 int buffer[2][9]={{0},{0}};
jakeb 15:688b3e3958fd 109 if (screenPtr == NULL) screenPtr = &screen;
jakeb 15:688b3e3958fd 110 do
jakeb 15:688b3e3958fd 111 {
jakeb 15:688b3e3958fd 112 TP_GetAdXY(TP_X,TP_Y);
jakeb 15:688b3e3958fd 113 buffer[0][count]=TP_X[0];
jakeb 15:688b3e3958fd 114 buffer[1][count]=TP_Y[0];
jakeb 15:688b3e3958fd 115 count++;
jakeb 15:688b3e3958fd 116 }
jakeb 15:688b3e3958fd 117 while(!_tp_irq && (count < 9));
jakeb 15:688b3e3958fd 118 if(count==9)
jakeb 15:688b3e3958fd 119 {
jakeb 15:688b3e3958fd 120 temp[0]=(buffer[0][0]+buffer[0][1]+buffer[0][2])/3;
jakeb 15:688b3e3958fd 121 temp[1]=(buffer[0][3]+buffer[0][4]+buffer[0][5])/3;
jakeb 15:688b3e3958fd 122 temp[2]=(buffer[0][6]+buffer[0][7]+buffer[0][8])/3;
jakeb 15:688b3e3958fd 123 m0=temp[0]-temp[1];
jakeb 15:688b3e3958fd 124 m1=temp[1]-temp[2];
jakeb 15:688b3e3958fd 125 m2=temp[2]-temp[0];
jakeb 15:688b3e3958fd 126 m0=m0>0?m0:(-m0);
jakeb 15:688b3e3958fd 127 m1=m1>0?m1:(-m1);
jakeb 15:688b3e3958fd 128 m2=m2>0?m2:(-m2);
jakeb 15:688b3e3958fd 129 if( (m0>THRESHOLD) && (m1>THRESHOLD) && (m2>THRESHOLD) ) return 0;
jakeb 15:688b3e3958fd 130 if(m0<m1)
jakeb 15:688b3e3958fd 131 {
jakeb 15:688b3e3958fd 132 if(m2<m0)
jakeb 15:688b3e3958fd 133 screenPtr->x=(temp[0]+temp[2])/2;
jakeb 15:688b3e3958fd 134 else
jakeb 15:688b3e3958fd 135 screenPtr->x=(temp[0]+temp[1])/2;
jakeb 15:688b3e3958fd 136 }
jakeb 15:688b3e3958fd 137 else if(m2<m1)
jakeb 15:688b3e3958fd 138 screenPtr->x=(temp[0]+temp[2])/2;
jakeb 15:688b3e3958fd 139 else
jakeb 15:688b3e3958fd 140 screenPtr->x=(temp[1]+temp[2])/2;
jakeb 15:688b3e3958fd 141
jakeb 15:688b3e3958fd 142 temp[0]=(buffer[1][0]+buffer[1][1]+buffer[1][2])/3;
jakeb 15:688b3e3958fd 143 temp[1]=(buffer[1][3]+buffer[1][4]+buffer[1][5])/3;
jakeb 15:688b3e3958fd 144 temp[2]=(buffer[1][6]+buffer[1][7]+buffer[1][8])/3;
jakeb 15:688b3e3958fd 145 m0=temp[0]-temp[1];
jakeb 15:688b3e3958fd 146 m1=temp[1]-temp[2];
jakeb 15:688b3e3958fd 147 m2=temp[2]-temp[0];
jakeb 15:688b3e3958fd 148 m0=m0>0?m0:(-m0);
jakeb 15:688b3e3958fd 149 m1=m1>0?m1:(-m1);
jakeb 15:688b3e3958fd 150 m2=m2>0?m2:(-m2);
jakeb 15:688b3e3958fd 151 if( (m0>THRESHOLD) && (m1>THRESHOLD) && (m2>THRESHOLD) ) return 0;
jakeb 15:688b3e3958fd 152
jakeb 15:688b3e3958fd 153 if(m0<m1)
jakeb 15:688b3e3958fd 154 {
jakeb 15:688b3e3958fd 155 if(m2<m0)
jakeb 15:688b3e3958fd 156 screenPtr->y=(temp[0]+temp[2])/2;
jakeb 15:688b3e3958fd 157 else
jakeb 15:688b3e3958fd 158 screenPtr->y=(temp[0]+temp[1])/2;
jakeb 15:688b3e3958fd 159 }
jakeb 15:688b3e3958fd 160 else if(m2<m1)
jakeb 15:688b3e3958fd 161 screenPtr->y=(temp[0]+temp[2])/2;
jakeb 15:688b3e3958fd 162 else
jakeb 15:688b3e3958fd 163 screenPtr->y=(temp[1]+temp[2])/2;
jakeb 15:688b3e3958fd 164 return 1;
jakeb 15:688b3e3958fd 165 }
jakeb 15:688b3e3958fd 166 return 0;
jakeb 15:688b3e3958fd 167 }
jakeb 15:688b3e3958fd 168
jakeb 15:688b3e3958fd 169 uint8_t TouchScreenADS7843::setCalibrationMatrix( Coordinate * displayPtr,
jakeb 15:688b3e3958fd 170 Coordinate * screenPtr,
jakeb 15:688b3e3958fd 171 Matrix * matrixPtr)
jakeb 15:688b3e3958fd 172 {
jakeb 15:688b3e3958fd 173 uint8_t retTHRESHOLD = 0 ;
jakeb 15:688b3e3958fd 174 // K = (Xs0 - Xs2)*(Ys1 - Ys2) - (Xs1 - Xs2)*(Ys0 - Ys2)
jakeb 15:688b3e3958fd 175 matrixPtr->Divider = ((screenPtr[0].x - screenPtr[2].x) * (screenPtr[1].y - screenPtr[2].y)) -
jakeb 15:688b3e3958fd 176 ((screenPtr[1].x - screenPtr[2].x) * (screenPtr[0].y - screenPtr[2].y)) ;
jakeb 15:688b3e3958fd 177 if( matrixPtr->Divider == 0 )
jakeb 15:688b3e3958fd 178 {
jakeb 15:688b3e3958fd 179 retTHRESHOLD = 1;
jakeb 15:688b3e3958fd 180 }
jakeb 15:688b3e3958fd 181 else
jakeb 15:688b3e3958fd 182 {
jakeb 15:688b3e3958fd 183 // (Xd0 - Xd2)*(Ys1 - Ys2) - (Xd1 - Xd2)*(Ys0 - Ys2)
jakeb 15:688b3e3958fd 184 // A = ---------------------------------------------------
jakeb 15:688b3e3958fd 185 // K
jakeb 15:688b3e3958fd 186 matrixPtr->An = ((displayPtr[0].x - displayPtr[2].x) * (screenPtr[1].y - screenPtr[2].y)) -
jakeb 15:688b3e3958fd 187 ((displayPtr[1].x - displayPtr[2].x) * (screenPtr[0].y - screenPtr[2].y)) ;
jakeb 15:688b3e3958fd 188 // (Xs0 - Xs2)*(Xd1 - Xd2) - (Xd0 - Xd2)*(Xs1 - Xs2)
jakeb 15:688b3e3958fd 189 // B = ---------------------------------------------------
jakeb 15:688b3e3958fd 190 // K
jakeb 15:688b3e3958fd 191 matrixPtr->Bn = ((screenPtr[0].x - screenPtr[2].x) * (displayPtr[1].x - displayPtr[2].x)) -
jakeb 15:688b3e3958fd 192 ((displayPtr[0].x - displayPtr[2].x) * (screenPtr[1].x - screenPtr[2].x)) ;
jakeb 15:688b3e3958fd 193 // Ys0*(Xs2*Xd1 - Xs1*Xd2) + Ys1*(Xs0*Xd2 - Xs2*Xd0) + Ys2*(Xs1*Xd0 - Xs0*Xd1)
jakeb 15:688b3e3958fd 194 // C = ----------------------------------------------------------------------------
jakeb 15:688b3e3958fd 195 // K
jakeb 15:688b3e3958fd 196 matrixPtr->Cn = (screenPtr[2].x * displayPtr[1].x - screenPtr[1].x * displayPtr[2].x) * screenPtr[0].y +
jakeb 15:688b3e3958fd 197 (screenPtr[0].x * displayPtr[2].x - screenPtr[2].x * displayPtr[0].x) * screenPtr[1].y +
jakeb 15:688b3e3958fd 198 (screenPtr[1].x * displayPtr[0].x - screenPtr[0].x * displayPtr[1].x) * screenPtr[2].y ;
jakeb 15:688b3e3958fd 199 // (Yd0 - Yd2)*(Ys1 - Ys2) - (Yd1 - Yd2)*(Ys0 - Ys2)
jakeb 15:688b3e3958fd 200 // D = ---------------------------------------------------
jakeb 15:688b3e3958fd 201 // K
jakeb 15:688b3e3958fd 202 matrixPtr->Dn = ((displayPtr[0].y - displayPtr[2].y) * (screenPtr[1].y - screenPtr[2].y)) -
jakeb 15:688b3e3958fd 203 ((displayPtr[1].y - displayPtr[2].y) * (screenPtr[0].y - screenPtr[2].y)) ;
jakeb 15:688b3e3958fd 204 // (Xs0 - Xs2)*(Yd1 - Yd2) - (Yd0 - Yd2)*(Xs1 - Xs2)
jakeb 15:688b3e3958fd 205 // E = ---------------------------------------------------
jakeb 15:688b3e3958fd 206 // K
jakeb 15:688b3e3958fd 207 matrixPtr->En = ((screenPtr[0].x - screenPtr[2].x) * (displayPtr[1].y - displayPtr[2].y)) -
jakeb 15:688b3e3958fd 208 ((displayPtr[0].y - displayPtr[2].y) * (screenPtr[1].x - screenPtr[2].x)) ;
jakeb 15:688b3e3958fd 209 // Ys0*(Xs2*Yd1 - Xs1*Yd2) + Ys1*(Xs0*Yd2 - Xs2*Yd0) + Ys2*(Xs1*Yd0 - Xs0*Yd1)
jakeb 15:688b3e3958fd 210 // F = ----------------------------------------------------------------------------
jakeb 15:688b3e3958fd 211 // K
jakeb 15:688b3e3958fd 212 matrixPtr->Fn = (screenPtr[2].x * displayPtr[1].y - screenPtr[1].x * displayPtr[2].y) * screenPtr[0].y +
jakeb 15:688b3e3958fd 213 (screenPtr[0].x * displayPtr[2].y - screenPtr[2].x * displayPtr[0].y) * screenPtr[1].y +
jakeb 15:688b3e3958fd 214 (screenPtr[1].x * displayPtr[0].y - screenPtr[0].x * displayPtr[1].y) * screenPtr[2].y ;
jakeb 15:688b3e3958fd 215 }
jakeb 15:688b3e3958fd 216 return( retTHRESHOLD ) ;
jakeb 15:688b3e3958fd 217 }
jakeb 15:688b3e3958fd 218
jakeb 15:688b3e3958fd 219 uint8_t TouchScreenADS7843::getDisplayPoint(void)
jakeb 15:688b3e3958fd 220 {
jakeb 15:688b3e3958fd 221 uint8_t retTHRESHOLD = 0 ;
jakeb 15:688b3e3958fd 222
jakeb 15:688b3e3958fd 223 if( matrix.Divider != 0 )
jakeb 15:688b3e3958fd 224 {
jakeb 15:688b3e3958fd 225 // XD = AX+BY+C
jakeb 15:688b3e3958fd 226 display.x = ( (matrix.An * screen.x) +
jakeb 15:688b3e3958fd 227 (matrix.Bn * screen.y) +
jakeb 15:688b3e3958fd 228 matrix.Cn
jakeb 15:688b3e3958fd 229 ) / matrix.Divider ;
jakeb 15:688b3e3958fd 230 // YD = DX+EY+F
jakeb 15:688b3e3958fd 231 display.y = ( (matrix.Dn * screen.x) +
jakeb 15:688b3e3958fd 232 (matrix.En * screen.y) +
jakeb 15:688b3e3958fd 233 matrix.Fn
jakeb 15:688b3e3958fd 234 ) / matrix.Divider ;
jakeb 15:688b3e3958fd 235 }
jakeb 15:688b3e3958fd 236 else
jakeb 15:688b3e3958fd 237 {
jakeb 15:688b3e3958fd 238 retTHRESHOLD = 1;
jakeb 15:688b3e3958fd 239 }
jakeb 15:688b3e3958fd 240 return(retTHRESHOLD);
jakeb 15:688b3e3958fd 241 }
jakeb 15:688b3e3958fd 242
jakeb 15:688b3e3958fd 243 void TouchScreenADS7843::TouchPanel_Calibrate(void)
jakeb 15:688b3e3958fd 244 {
jakeb 15:688b3e3958fd 245 uint8_t i;
jakeb 15:688b3e3958fd 246 Coordinate screen_cal;
jakeb 15:688b3e3958fd 247 setCalibrationMatrix( &DisplaySample[0],&ScreenSample[0],&matrix) ;
jakeb 15:688b3e3958fd 248 LCD->set_font((unsigned char*) Arial12x12);
jakeb 15:688b3e3958fd 249 for(i=0;i<3;i++)
jakeb 15:688b3e3958fd 250 {
jakeb 15:688b3e3958fd 251 LCD->cls();
jakeb 15:688b3e3958fd 252 LCD->locate(10,10);
jakeb 15:688b3e3958fd 253 LCD->printf("Touch crosshair to calibrate");
jakeb 15:688b3e3958fd 254 wait_ms(500);
jakeb 15:688b3e3958fd 255 DrawCross(DisplaySample[i].x,DisplaySample[i].y);
jakeb 15:688b3e3958fd 256 do {} while (!Read_Ads7846(&screen_cal));
jakeb 15:688b3e3958fd 257 ScreenSample[i].x= screen_cal.x;ScreenSample[i].y= screen_cal.y;
jakeb 15:688b3e3958fd 258 }
jakeb 15:688b3e3958fd 259 setCalibrationMatrix( &DisplaySample[0],&ScreenSample[0],&matrix) ;
jakeb 15:688b3e3958fd 260 LCD->cls();
jakeb 15:688b3e3958fd 261 }
jakeb 15:688b3e3958fd 262