Initial commit
This commit is contained in:
Julien Chevalley
282
nokia.c
Normal file
282
nokia.c
Normal file
@@ -0,0 +1,282 @@
|
||||
#include "stm32f7xx_hal.h"
|
||||
#include <string.h>
|
||||
|
||||
#include <stdio.h>
|
||||
#include "nokia.h"
|
||||
#include "spi.h"
|
||||
|
||||
//////////////////////////////////////////////////////////////////////////////////
|
||||
/// \file nokia.c
|
||||
/// \brief Nokia functions
|
||||
/// \version 1.0 first release
|
||||
/// \author Pascal Sartoretti (sap at hevs dot ch)
|
||||
/// \date 04-2014
|
||||
/// \details The LCD is connected to the module interface bus
|
||||
///
|
||||
///-------------------------------------------------------------------------------
|
||||
//////////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
//-----------------------------------------------------------------------------
|
||||
// NOKIA CONSTANTS DEFINITIONS
|
||||
//-----------------------------------------------------------------------------
|
||||
#define DISPLAY_SEG_ON 0x09 // all display segment on
|
||||
#define DISPLAY_INVERSE_VIDEO 0x0D // inverse video mode
|
||||
#define DISPLAY_BLANK 0x08 // display blank
|
||||
#define DISPLAY_NORMAL 0x0C // display in normal mode
|
||||
#define SET_BASIC_MODE 0x20 // use basic instruction set
|
||||
#define SET_EXTENDED_MODE 0x21 // use extended instruction set
|
||||
#define VDD_LCD 0xC8 // VDD_LCD parameters
|
||||
#define VDD_LCD_REG 0x80 // access of LCD_VDD register
|
||||
#define CONTRAST_REG 0x10 // access of CONTRAST register
|
||||
#define YPOS_REG 0x40 // access of Y_POS register
|
||||
#define XPOS_REG 0x80 // access of X_POS register
|
||||
#define X_NB_PIXELS 84 // Pixels in X
|
||||
#define Y_NB_PIXELS 48 // Pixels in Y
|
||||
#define Y_NB_LINES 6 // Number of lines
|
||||
|
||||
|
||||
uint8_t gNokiaBuffer[X_NB_PIXELS * Y_NB_LINES];
|
||||
uint8_t * gNokiaBufferPtr = gNokiaBuffer;
|
||||
|
||||
const size_t gNokiaBufferSize = sizeof(gNokiaBuffer);
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
void NokiaControl(uint8_t controlByte) {
|
||||
// TODO: write code here
|
||||
HAL_GPIO_WritePin(D_C_NOKIA_GPIO_Port, D_C_NOKIA_Pin, GPIO_PIN_RESET);
|
||||
HAL_GPIO_WritePin(CS_NOKIA_GPIO_Port, CS_NOKIA_Pin, GPIO_PIN_RESET);
|
||||
|
||||
// HAL_StatusTypeDef HAL_SPI_Transmit(SPI_HandleTypeDef *hspi, uint8_t *pData, uint16_t Size, uint32_t Timeout)
|
||||
/*
|
||||
HAL_OK = 0x00U,
|
||||
HAL_ERROR = 0x01U,
|
||||
HAL_BUSY = 0x02U,
|
||||
HAL_TIMEOUT = 0x03U
|
||||
*/
|
||||
|
||||
if(HAL_SPI_Transmit(&hspi2, &controlByte, 1, 0)!=HAL_OK){
|
||||
//#PROBLEM !!!
|
||||
printf("Error while sending Control Data\r\n");
|
||||
}
|
||||
HAL_GPIO_WritePin(CS_NOKIA_GPIO_Port, CS_NOKIA_Pin, GPIO_PIN_SET);
|
||||
HAL_GPIO_WritePin(D_C_NOKIA_GPIO_Port, D_C_NOKIA_Pin, GPIO_PIN_SET);
|
||||
|
||||
|
||||
// Code Done
|
||||
|
||||
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
void NokiaData(uint8_t dataByte)
|
||||
{
|
||||
// TODO: write code here
|
||||
HAL_GPIO_WritePin(CS_NOKIA_GPIO_Port, CS_NOKIA_Pin, GPIO_PIN_RESET);
|
||||
|
||||
// HAL_StatusTypeDef HAL_SPI_Transmit(SPI_HandleTypeDef *hspi, uint8_t *pData, uint16_t Size, uint32_t Timeout)
|
||||
/*
|
||||
HAL_OK = 0x00U,
|
||||
HAL_ERROR = 0x01U,
|
||||
HAL_BUSY = 0x02U,
|
||||
HAL_TIMEOUT = 0x03U
|
||||
*/
|
||||
|
||||
if(HAL_SPI_Transmit(&hspi2, &dataByte, 1, 0)!=HAL_OK){
|
||||
//#PROBLEM !!!
|
||||
printf("Error while sending Control Data\r\n");
|
||||
}
|
||||
HAL_GPIO_WritePin(CS_NOKIA_GPIO_Port, CS_NOKIA_Pin, GPIO_PIN_SET);
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
void Nokia_Init(void)
|
||||
{
|
||||
HAL_GPIO_WritePin(RST_NOKIA_GPIO_Port, RST_NOKIA_Pin, GPIO_PIN_SET);
|
||||
//HAL_GPIO_WritePin(D_C_NOKIA_GPIO_Port, D_C_NOKIA_Pin, GPIO_PIN_SET);
|
||||
HAL_GPIO_WritePin(CS_NOKIA_GPIO_Port, CS_NOKIA_Pin, GPIO_PIN_SET);
|
||||
//-------------------------------------------------------------------------
|
||||
// Setup the Nokia LCD for standard usage
|
||||
//-------------------------------------------------------------------------
|
||||
NokiaControl(SET_EXTENDED_MODE);
|
||||
NokiaControl(VDD_LCD_REG + 62);
|
||||
NokiaControl(CONTRAST_REG + 3);
|
||||
NokiaControl(SET_BASIC_MODE);
|
||||
NokiaControl(DISPLAY_SEG_ON);
|
||||
NokiaControl(DISPLAY_BLANK);
|
||||
NokiaControl(DISPLAY_NORMAL);
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
void NokiaGotoXY(uint8_t posX, uint8_t posY)
|
||||
{
|
||||
NokiaControl(YPOS_REG | (posY & 0x07)); // Y axe init: 0100 0yyy
|
||||
NokiaControl(XPOS_REG | (posX & 0x7f)); // X axe init: 1xxx xxxx
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
void NokiaClrDisplay(void)
|
||||
{
|
||||
memset(gNokiaBufferPtr, 0x0, X_NB_PIXELS * Y_NB_LINES);
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
void NokiaUpdate(void)
|
||||
{
|
||||
uint16_t i; // for local counter
|
||||
|
||||
NokiaGotoXY(0, 0); // topleft corner of screen
|
||||
//-------------------------------------------------------------------------
|
||||
for (i = 0; i < X_NB_PIXELS * Y_NB_LINES; i++) // for size of display
|
||||
{
|
||||
NokiaData(gNokiaBufferPtr[i]); // display memory content
|
||||
}
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
void NokiaSetPixel(uint8_t posX, uint8_t posY)
|
||||
{
|
||||
|
||||
if ((posX > 83) || (posY > 47))
|
||||
{
|
||||
return;
|
||||
}
|
||||
// write a pixel on the display buffer
|
||||
gNokiaBufferPtr[posX + 84 * (posY >> 3)] |= 1 << (posY & 0x07);
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
void NokiaClrPixel(uint8_t posX, uint8_t posY)
|
||||
{
|
||||
if ((posX > 83) || (posY > 47))
|
||||
{
|
||||
return;
|
||||
}
|
||||
// clear a pixel on the display buffer
|
||||
gNokiaBufferPtr[posX + 84 * (posY >> 3)] &= ~(1 << (posY & 0x07));
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
void NokiaColorPixel(uint8_t posX, uint8_t posY, uint8_t color)
|
||||
{
|
||||
if ((posX > 83) || (posY > 47))
|
||||
{
|
||||
return;
|
||||
}
|
||||
// clear a pixel on the display buffer
|
||||
if(color == 0)
|
||||
{
|
||||
gNokiaBufferPtr[posX + 84 * (posY >> 3)] &= ~(1 << (posY & 0x07));
|
||||
}
|
||||
else // set this pixel
|
||||
{
|
||||
gNokiaBufferPtr[posX + 84 * (posY >> 3)] |= 1 << (posY & 0x07);
|
||||
}
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
void NokiaDrawLine(uint8_t posX1, uint8_t posY1, uint8_t posX2, uint8_t posY2,
|
||||
uint8_t color)
|
||||
{
|
||||
int16_t posX;
|
||||
int16_t posY;
|
||||
uint8_t temp;
|
||||
|
||||
if ((posX1 > 83) || (posY1 > 47) || (posX2 > 83) || (posY2 > 47))
|
||||
{
|
||||
return;
|
||||
}
|
||||
//---------------------------------------------------------------------
|
||||
// line in quadrant 2 or 4
|
||||
//---------------------------------------------------------------------
|
||||
if (((posX1 > posX2) && (posY1 > posY2)) // QUADRANT 2
|
||||
|| ((posX1 < posX2) && (posY1 < posY2))) // or QUADRANT 4
|
||||
{
|
||||
//-----------------------------------------------------------------
|
||||
if (posX1 > posX2) // QUADRANT 2 ONLY
|
||||
{
|
||||
temp = posX1; // swap posX1 <> posX2
|
||||
posX1 = posX2;
|
||||
posX2 = temp;
|
||||
temp = posY1; // swap posY1 <> posY2
|
||||
posY1 = posY2;
|
||||
posY2 = temp;
|
||||
}
|
||||
//-----------------------------------------------------------------
|
||||
if ((posX2 - posX1) > (posY2 - posY1)) // angle is less 45 deg
|
||||
{
|
||||
for (posX = posX1; posX <= posX2; posX++) // display the line
|
||||
{
|
||||
posY = posY2
|
||||
- ((((posY2 - posY1) * (posX2 - posX)) * 16)
|
||||
/ (posX2 - posX1) + 8) / 16;
|
||||
NokiaColorPixel(posX, posY,color);
|
||||
}
|
||||
}
|
||||
//-----------------------------------------------------------------
|
||||
else // line angle more 45 deg
|
||||
{
|
||||
for (posY = posY1; posY <= posY2; posY++) // display the line
|
||||
{
|
||||
posX = posX2
|
||||
- ((((posX2 - posX1) * (posY2 - posY)) * 16)
|
||||
/ (posY2 - posY1) + 8) / 16;
|
||||
NokiaColorPixel(posX, posY,color);
|
||||
}
|
||||
}
|
||||
}
|
||||
//---------------------------------------------------------------------
|
||||
// line in quadrant 1 or 3
|
||||
//---------------------------------------------------------------------
|
||||
else
|
||||
{
|
||||
if (posX1 > posX2) // QUADRANT 1
|
||||
{
|
||||
temp = posX1; // swap posX1 <> posX2
|
||||
posX1 = posX2;
|
||||
posX2 = temp;
|
||||
}
|
||||
//-----------------------------------------------------------------
|
||||
else if (posY1 > posY2) // QUADRANT 3
|
||||
{
|
||||
temp = posY1; // swap posY1 <> posY2
|
||||
posY1 = posY2;
|
||||
posY2 = temp;
|
||||
}
|
||||
//-----------------------------------------------------------------
|
||||
if ((posX2 - posX1) > (posY2 - posY1)) // angle is less 45 deg
|
||||
{
|
||||
for (posX = posX1; posX <= posX2; posX++) // display the line
|
||||
{
|
||||
posY = posY1
|
||||
+ ((((posY2 - posY1) * (posX2 - posX)) * 16)
|
||||
/ (posX2 - posX1) + 8) / 16;
|
||||
NokiaColorPixel(posX, posY,color);
|
||||
}
|
||||
}
|
||||
else // angle is more 45 deg
|
||||
{
|
||||
if (posY1 == posY2)
|
||||
{
|
||||
NokiaColorPixel(posX1, posY1,color);
|
||||
return;
|
||||
}
|
||||
for (posY = posY1; posY <= posY2; posY++) // display the line
|
||||
{
|
||||
posX = posX1
|
||||
+ ((((posX2 - posX1) * (posY2 - posY)) * 16)
|
||||
/ (posY2 - posY1) + 8) / 16;
|
||||
NokiaColorPixel(posX, posY,color);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user