Simply creates a servo object from a motor object, to allow the control of the angle.

Dependencies:   mbed

Fork of Lab5_Basic by ziad eldebri

Committer:
dogcatfee
Date:
Fri Nov 03 19:28:37 2017 -0700
Revision:
12:988fb6ffae63
Parent:
9:e2909d7f36b8
Cleanup, comment, position fixes.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dogcatfee 9:e2909d7f36b8 1 #include "SLCD.h"
dogcatfee 9:e2909d7f36b8 2 #include "LCDconfig.h"
dogcatfee 9:e2909d7f36b8 3
dogcatfee 9:e2909d7f36b8 4
dogcatfee 9:e2909d7f36b8 5 const uint8_t WF_ORDERING_TABLE[ ] =
dogcatfee 9:e2909d7f36b8 6 {
dogcatfee 9:e2909d7f36b8 7 CHAR1a, // LCD81 --- Pin:5 LCDnAddress=51
dogcatfee 9:e2909d7f36b8 8 CHAR1b, // LCD82 --- Pin:6 LCDnAddress=52
dogcatfee 9:e2909d7f36b8 9 CHAR2a, // LCD83 --- Pin:7 LCDnAddress=53
dogcatfee 9:e2909d7f36b8 10 CHAR2b, // LCD84 --- Pin:8 LCDnAddress=54
dogcatfee 9:e2909d7f36b8 11 CHAR3a, // LCD85 --- Pin:9 LCDnAddress=55
dogcatfee 9:e2909d7f36b8 12 CHAR3b, // LCD86 --- Pin:10 LCDnAddress=56
dogcatfee 9:e2909d7f36b8 13 CHAR4a, // LCD87 --- Pin:11 LCDnAddress=57
dogcatfee 9:e2909d7f36b8 14 CHAR4b, // LCD88 --- Pin:12 LCDnAddress=58
dogcatfee 9:e2909d7f36b8 15 CHARCOM0, // LCD77 --- Pin:1 LCDnAddress=4D
dogcatfee 9:e2909d7f36b8 16 CHARCOM1, // LCD78 --- Pin:2 LCDnAddress=4E
dogcatfee 9:e2909d7f36b8 17 CHARCOM2, // LCD79 --- Pin:3 LCDnAddress=4F
dogcatfee 9:e2909d7f36b8 18 CHARCOM3, // LCD80 --- Pin:4 LCDnAddress=50
dogcatfee 9:e2909d7f36b8 19 };
dogcatfee 9:e2909d7f36b8 20
dogcatfee 9:e2909d7f36b8 21 const char ASCII_TO_WF_CODIFICATION_TABLE [ ] =
dogcatfee 9:e2909d7f36b8 22 {
dogcatfee 9:e2909d7f36b8 23
dogcatfee 9:e2909d7f36b8 24 /*
dogcatfee 9:e2909d7f36b8 25 segA
dogcatfee 9:e2909d7f36b8 26 ________
dogcatfee 9:e2909d7f36b8 27 | |
dogcatfee 9:e2909d7f36b8 28 segF | | segB
dogcatfee 9:e2909d7f36b8 29 | |
dogcatfee 9:e2909d7f36b8 30 -segG--
dogcatfee 9:e2909d7f36b8 31 | |
dogcatfee 9:e2909d7f36b8 32 segE | | segC
dogcatfee 9:e2909d7f36b8 33 |________|
dogcatfee 9:e2909d7f36b8 34 segD
dogcatfee 9:e2909d7f36b8 35 */
dogcatfee 9:e2909d7f36b8 36
dogcatfee 9:e2909d7f36b8 37 ( SEGD+ SEGE+ SEGF+!SEGG) , ( SEGC+ SEGB+ SEGA) ,//Char = 0, offset=0
dogcatfee 9:e2909d7f36b8 38 (!SEGD+!SEGE+!SEGF+!SEGG) , ( SEGC+ SEGB+!SEGA) ,//Char = 1, offset=4
dogcatfee 9:e2909d7f36b8 39 ( SEGD+ SEGE+!SEGF+ SEGG) , (!SEGC+ SEGB+ SEGA) ,//Char = 2, offset=8
dogcatfee 9:e2909d7f36b8 40 ( SEGD+!SEGE+!SEGF+ SEGG) , ( SEGC+ SEGB+ SEGA) ,//Char = 3, offset=12
dogcatfee 9:e2909d7f36b8 41 (!SEGD+!SEGE+ SEGF+ SEGG) , ( SEGC+ SEGB+!SEGA) ,//Char = 4, offset=16
dogcatfee 9:e2909d7f36b8 42 ( SEGD+!SEGE+ SEGF+ SEGG) , ( SEGC+!SEGB+ SEGA) ,//Char = 5, offset=20
dogcatfee 9:e2909d7f36b8 43 ( SEGD+ SEGE+ SEGF+ SEGG) , ( SEGC+!SEGB+ SEGA) ,//Char = 6, offset=24
dogcatfee 9:e2909d7f36b8 44 (!SEGD+!SEGE+!SEGF+!SEGG) , ( SEGC+ SEGB+ SEGA) ,//Char = 7, offset=28
dogcatfee 9:e2909d7f36b8 45 ( SEGD+ SEGE+ SEGF+ SEGG) , ( SEGC+ SEGB+ SEGA) ,//Char = 8, offset=32
dogcatfee 9:e2909d7f36b8 46 ( SEGD+!SEGE+ SEGF+ SEGG) , ( SEGC+ SEGB+ SEGA) ,//Char = 9, offset=36
dogcatfee 9:e2909d7f36b8 47 (!SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+!SEGA) ,//Char = :, offset=40
dogcatfee 9:e2909d7f36b8 48 (!SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+!SEGA) ,//Char = ;, offset=44
dogcatfee 9:e2909d7f36b8 49 (!SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+!SEGA) ,//Char = <, offset=48
dogcatfee 9:e2909d7f36b8 50 ( SEGD+!SEGE+!SEGF+ SEGG) , (!SEGC+!SEGB+!SEGA) ,//Char = =, offset=52
dogcatfee 9:e2909d7f36b8 51 (!SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+!SEGA) ,//Char = >, offset=56
dogcatfee 9:e2909d7f36b8 52 (!SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+ SEGA) ,//Char = ?, offset=60
dogcatfee 9:e2909d7f36b8 53 ( SEGD+ SEGE+ SEGF+ SEGG) , ( SEGC+ SEGB+ SEGA) ,//Char = @, offset=64
dogcatfee 9:e2909d7f36b8 54 (!SEGD+ SEGE+ SEGF+ SEGG) , ( SEGC+ SEGB+ SEGA) ,//Char = A, offset=68
dogcatfee 9:e2909d7f36b8 55 ( SEGD+ SEGE+ SEGF+ SEGG) , ( SEGC+!SEGB+!SEGA) ,//Char = B, offset=72
dogcatfee 9:e2909d7f36b8 56 ( SEGD+ SEGE+ SEGF+!SEGG) , (!SEGC+!SEGB+ SEGA) ,//Char = C, offset=76
dogcatfee 9:e2909d7f36b8 57 ( SEGD+ SEGE+!SEGF+ SEGG) , ( SEGC+ SEGB+!SEGA) ,//Char = D, offset=80
dogcatfee 9:e2909d7f36b8 58 ( SEGD+ SEGE+ SEGF+ SEGG) , (!SEGC+!SEGB+ SEGA) ,//Char = E, offset=84
dogcatfee 9:e2909d7f36b8 59 (!SEGD+ SEGE+ SEGF+ SEGG) , (!SEGC+!SEGB+ SEGA) ,//Char = F, offset=88
dogcatfee 9:e2909d7f36b8 60 ( SEGD+ SEGE+ SEGF+ SEGG) , ( SEGC+!SEGB+ SEGA) ,//Char = G, offset=92
dogcatfee 9:e2909d7f36b8 61 (!SEGD+ SEGE+ SEGF+ SEGG) , ( SEGC+ SEGB+!SEGA) ,//Char = H, offset=96
dogcatfee 9:e2909d7f36b8 62 (!SEGD+!SEGE+!SEGF+!SEGG) , ( SEGC+!SEGB+!SEGA) ,//Char = I, offset=100
dogcatfee 9:e2909d7f36b8 63 ( SEGD+ SEGE+!SEGF+!SEGG) , ( SEGC+ SEGB+!SEGA) ,//Char = J, offset=104
dogcatfee 9:e2909d7f36b8 64 (!SEGD+ SEGE+ SEGF+ SEGG) , ( SEGC+!SEGB+ SEGA) ,//Char = K, offset=108
dogcatfee 9:e2909d7f36b8 65 ( SEGD+ SEGE+ SEGF+!SEGG) , (!SEGC+!SEGB+!SEGA) ,//Char = L, offset=112
dogcatfee 9:e2909d7f36b8 66 (!SEGD+ SEGE+ SEGF+!SEGG) , ( SEGC+ SEGB+ SEGA) ,//Char = M, offset=116
dogcatfee 9:e2909d7f36b8 67 (!SEGD+ SEGE+!SEGF+ SEGG) , ( SEGC+!SEGB+!SEGA) ,//Char = N, offset=120
dogcatfee 9:e2909d7f36b8 68 ( SEGD+ SEGE+!SEGF+ SEGG) , ( SEGC+!SEGB+!SEGA) ,//Char = O, offset=124
dogcatfee 9:e2909d7f36b8 69 (!SEGD+ SEGE+ SEGF+ SEGG) , (!SEGC+ SEGB+ SEGA) ,//Char = P, offset=128
dogcatfee 9:e2909d7f36b8 70 ( SEGD+!SEGE+ SEGF+ SEGG) , ( SEGC+ SEGB+ SEGA) ,//Char = Q, offset=132
dogcatfee 9:e2909d7f36b8 71 (!SEGD+ SEGE+!SEGF+ SEGG) , (!SEGC+!SEGB+!SEGA) ,//Char = R, offset=136
dogcatfee 9:e2909d7f36b8 72 ( SEGD+!SEGE+ SEGF+ SEGG) , ( SEGC+!SEGB+ SEGA) ,//Char = S, offset=140
dogcatfee 9:e2909d7f36b8 73 ( SEGD+ SEGE+ SEGF+ SEGG) , (!SEGC+!SEGB+!SEGA) ,//Char = T, offset=144
dogcatfee 9:e2909d7f36b8 74 ( SEGD+ SEGE+ SEGF+!SEGG) , ( SEGC+ SEGB+!SEGA) ,//Char = U, offset=148
dogcatfee 9:e2909d7f36b8 75 ( SEGD+ SEGE+!SEGF+!SEGG) , ( SEGC+!SEGB+!SEGA) ,//Char = V, offset=152
dogcatfee 9:e2909d7f36b8 76 ( SEGD+ SEGE+ SEGF+!SEGG) , ( SEGC+ SEGB+!SEGA) ,//Char = W, offset=156
dogcatfee 9:e2909d7f36b8 77 (!SEGD+ SEGE+ SEGF+ SEGG) , ( SEGC+ SEGB+!SEGA) ,//Char = X, offset=160
dogcatfee 9:e2909d7f36b8 78 ( SEGD+!SEGE+ SEGF+ SEGG) , ( SEGC+ SEGB+!SEGA) ,//Char = Y, offset=164
dogcatfee 9:e2909d7f36b8 79 ( SEGD+!SEGE+!SEGF+ SEGG) , (!SEGC+!SEGB+!SEGA) ,//Char = Z, offset=168
dogcatfee 9:e2909d7f36b8 80 ( SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+ SEGA) ,//Char = [, offset=172
dogcatfee 9:e2909d7f36b8 81 ( SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+ SEGA) ,//Char = \, offset=176
dogcatfee 9:e2909d7f36b8 82 ( SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+ SEGA) ,//Char = ], offset=180
dogcatfee 9:e2909d7f36b8 83 ( SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+ SEGA) ,//Char = ^, offset=184
dogcatfee 9:e2909d7f36b8 84 ( SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+ SEGA) ,//Char = _, offset=188
dogcatfee 9:e2909d7f36b8 85 ( SEGD+!SEGE+!SEGF+!SEGG) , (!SEGC+!SEGB+ SEGA) ,//Char = `, offset=192
dogcatfee 9:e2909d7f36b8 86 };
dogcatfee 9:e2909d7f36b8 87
dogcatfee 9:e2909d7f36b8 88 SLCD::SLCD() {
dogcatfee 9:e2909d7f36b8 89 init();
dogcatfee 9:e2909d7f36b8 90 CharPosition = 0;
dogcatfee 9:e2909d7f36b8 91 }
dogcatfee 9:e2909d7f36b8 92
dogcatfee 9:e2909d7f36b8 93 void SLCD::init(){
dogcatfee 9:e2909d7f36b8 94 SIM->SCGC5 |= SIM_SCGC5_SLCD_MASK | SIM_SCGC5_PORTB_MASK | SIM_SCGC5_PORTC_MASK | SIM_SCGC5_PORTD_MASK | SIM_SCGC5_PORTE_MASK;
dogcatfee 9:e2909d7f36b8 95
dogcatfee 9:e2909d7f36b8 96 // configure pins for LCD operation
dogcatfee 9:e2909d7f36b8 97 PORTC->PCR[20] = 0x00000000; //VLL2
dogcatfee 9:e2909d7f36b8 98 PORTC->PCR[21] = 0x00000000; //VLL1
dogcatfee 9:e2909d7f36b8 99 PORTC->PCR[22] = 0x00000000; //VCAP2
dogcatfee 9:e2909d7f36b8 100 PORTC->PCR[23] = 0x00000000; //VCAP1
dogcatfee 9:e2909d7f36b8 101 // Enable IRCLK
dogcatfee 9:e2909d7f36b8 102 MCG->C1 = MCG_C1_IRCLKEN_MASK | MCG_C1_IREFSTEN_MASK;
dogcatfee 9:e2909d7f36b8 103 MCG->C2 &= ~MCG_C2_IRCS_MASK ; //0 32KHZ internal reference clock; 1= 4MHz irc
dogcatfee 9:e2909d7f36b8 104 LCD->GCR = 0x0;
dogcatfee 9:e2909d7f36b8 105 LCD->AR = 0x0;
dogcatfee 9:e2909d7f36b8 106 // LCD configurartion
dogcatfee 9:e2909d7f36b8 107 LCD->GCR = ( LCD_GCR_RVEN_MASK*_LCDRVEN
dogcatfee 9:e2909d7f36b8 108 | LCD_GCR_RVTRIM(_LCDRVTRIM) //0-15
dogcatfee 9:e2909d7f36b8 109 | LCD_GCR_CPSEL_MASK*_LCDCPSEL
dogcatfee 9:e2909d7f36b8 110 | LCD_GCR_LADJ(_LCDLOADADJUST) //0-3
dogcatfee 9:e2909d7f36b8 111 | LCD_GCR_VSUPPLY_MASK*_LCDSUPPLY //0-1
dogcatfee 9:e2909d7f36b8 112 |!LCD_GCR_FDCIEN_MASK
dogcatfee 9:e2909d7f36b8 113 | LCD_GCR_ALTDIV(_LCDALTDIV) //0-3
dogcatfee 9:e2909d7f36b8 114 |!LCD_GCR_LCDDOZE_MASK
dogcatfee 9:e2909d7f36b8 115 |!LCD_GCR_LCDSTP_MASK
dogcatfee 9:e2909d7f36b8 116 |!LCD_GCR_LCDEN_MASK //WILL BE ENABLE ON SUBSEQUENT STEP
dogcatfee 9:e2909d7f36b8 117 | LCD_GCR_SOURCE_MASK*_LCDCLKSOURCE
dogcatfee 9:e2909d7f36b8 118 | LCD_GCR_ALTSOURCE_MASK*_LCDALRCLKSOURCE
dogcatfee 9:e2909d7f36b8 119 | LCD_GCR_LCLK(_LCDLCK) //0-7
dogcatfee 9:e2909d7f36b8 120 | LCD_GCR_DUTY(_LCDDUTY) //0-7
dogcatfee 9:e2909d7f36b8 121 );
dogcatfee 9:e2909d7f36b8 122 uint8_t i;
dogcatfee 9:e2909d7f36b8 123 uint32_t *p_pen;
dogcatfee 9:e2909d7f36b8 124 uint8_t pen_offset; // 0 or 1
dogcatfee 9:e2909d7f36b8 125 uint8_t pen_bit; // 0 to 31
dogcatfee 9:e2909d7f36b8 126 LCD->PEN[0] = 0x0;
dogcatfee 9:e2909d7f36b8 127 LCD->PEN[1] = 0x0;
dogcatfee 9:e2909d7f36b8 128 LCD->BPEN[0] = 0x0;
dogcatfee 9:e2909d7f36b8 129 LCD->BPEN[1] = 0x0;
dogcatfee 9:e2909d7f36b8 130 p_pen = (uint32_t *)&LCD->PEN[0];
dogcatfee 9:e2909d7f36b8 131 for (i=0;i<_LCDUSEDPINS;i++)
dogcatfee 9:e2909d7f36b8 132 {
dogcatfee 9:e2909d7f36b8 133 pen_offset = WF_ORDERING_TABLE[i]/32;
dogcatfee 9:e2909d7f36b8 134 pen_bit = WF_ORDERING_TABLE[i]%32;
dogcatfee 9:e2909d7f36b8 135 p_pen[pen_offset] |= 1 << pen_bit;
dogcatfee 9:e2909d7f36b8 136 if (i>= _LCDFRONTPLANES) // Pin is a backplane
dogcatfee 9:e2909d7f36b8 137 {
dogcatfee 9:e2909d7f36b8 138 p_pen[pen_offset+2] |= 1 << pen_bit; // Enable BPEN
dogcatfee 9:e2909d7f36b8 139 LCD->WF8B[(uint8_t)WF_ORDERING_TABLE[i]] = 1 << (i - _LCDFRONTPLANES); // fill with 0x01, 0x02, etc
dogcatfee 9:e2909d7f36b8 140 }
dogcatfee 9:e2909d7f36b8 141 }
dogcatfee 9:e2909d7f36b8 142 LCD->GCR |= LCD_GCR_LCDEN_MASK;
dogcatfee 9:e2909d7f36b8 143 }
dogcatfee 9:e2909d7f36b8 144
dogcatfee 9:e2909d7f36b8 145 int SLCD::_putc(int c) {
dogcatfee 9:e2909d7f36b8 146 Write_Char(c);
dogcatfee 9:e2909d7f36b8 147 return 0;
dogcatfee 9:e2909d7f36b8 148 }
dogcatfee 9:e2909d7f36b8 149
dogcatfee 9:e2909d7f36b8 150 void SLCD::Write_Char (char lbValue) {
dogcatfee 9:e2909d7f36b8 151 uint8_t char_val;
dogcatfee 9:e2909d7f36b8 152 uint8_t temp;
dogcatfee 9:e2909d7f36b8 153 uint8_t *lbpLCDWF;
dogcatfee 9:e2909d7f36b8 154 uint8_t lbCounter;
dogcatfee 9:e2909d7f36b8 155 uint16_t arrayOffset;
dogcatfee 9:e2909d7f36b8 156 uint8_t position;
dogcatfee 9:e2909d7f36b8 157
dogcatfee 9:e2909d7f36b8 158 if (CharPosition >= _CHARNUM)
dogcatfee 9:e2909d7f36b8 159 CharPosition = 0;
dogcatfee 9:e2909d7f36b8 160 lbpLCDWF = (uint8_t *)&LCD->WF8B[0];
dogcatfee 9:e2909d7f36b8 161 /* only ascii character if value not writeable write as @ */
dogcatfee 9:e2909d7f36b8 162 if (lbValue>='a' && lbValue<='z') {
dogcatfee 9:e2909d7f36b8 163 lbValue -= 32; // UpperCase
dogcatfee 9:e2909d7f36b8 164 }
dogcatfee 9:e2909d7f36b8 165 if (lbValue<ASCCI_TABLE_START || lbValue >ASCCI_TABLE_END) {
dogcatfee 9:e2909d7f36b8 166 lbValue = BLANK_CHARACTER; // default value as space
dogcatfee 9:e2909d7f36b8 167 }
dogcatfee 9:e2909d7f36b8 168 lbValue -=ASCCI_TABLE_START; // Remove the offset to search in the ascci table
dogcatfee 9:e2909d7f36b8 169 arrayOffset = (lbValue * _CHAR_SIZE); // Compensate matrix offset
dogcatfee 9:e2909d7f36b8 170 // ensure bLCD position is in valid limit
dogcatfee 9:e2909d7f36b8 171 lbCounter = 0; //number of writings to complete one char
dogcatfee 9:e2909d7f36b8 172 while (lbCounter<_CHAR_SIZE) {
dogcatfee 9:e2909d7f36b8 173 position = (CharPosition) *_LCDTYPE + lbCounter;
dogcatfee 9:e2909d7f36b8 174 temp=0;
dogcatfee 9:e2909d7f36b8 175 if (lbCounter==1) {
dogcatfee 9:e2909d7f36b8 176 temp = lbpLCDWF[WF_ORDERING_TABLE[position]] & 0x01;//bit 0 has the special symbol information
dogcatfee 9:e2909d7f36b8 177 }
dogcatfee 9:e2909d7f36b8 178 char_val = ASCII_TO_WF_CODIFICATION_TABLE[arrayOffset + lbCounter];
dogcatfee 9:e2909d7f36b8 179 lbpLCDWF[WF_ORDERING_TABLE[position]] = char_val | temp;
dogcatfee 9:e2909d7f36b8 180 // if (char_val==0) lbCounter = _CHAR_SIZE; //end of this character
dogcatfee 9:e2909d7f36b8 181 lbCounter++;
dogcatfee 9:e2909d7f36b8 182 }
dogcatfee 9:e2909d7f36b8 183 CharPosition++;
dogcatfee 9:e2909d7f36b8 184 }
dogcatfee 9:e2909d7f36b8 185
dogcatfee 9:e2909d7f36b8 186 void SLCD::Home (void)
dogcatfee 9:e2909d7f36b8 187 {
dogcatfee 9:e2909d7f36b8 188 CharPosition = 0;
dogcatfee 9:e2909d7f36b8 189 }
dogcatfee 9:e2909d7f36b8 190
dogcatfee 9:e2909d7f36b8 191 void SLCD::Contrast (uint8_t lbContrast)
dogcatfee 9:e2909d7f36b8 192 {
dogcatfee 9:e2909d7f36b8 193 lbContrast &= 0x0F; //Forced to the only values accepted
dogcatfee 9:e2909d7f36b8 194 LCD->GCR |= LCD_GCR_RVTRIM(lbContrast);
dogcatfee 9:e2909d7f36b8 195 }
dogcatfee 9:e2909d7f36b8 196
dogcatfee 9:e2909d7f36b8 197 void SLCD::All_Segments (int mode)
dogcatfee 9:e2909d7f36b8 198 {
dogcatfee 9:e2909d7f36b8 199 uint8_t lbTotalBytes = _CHARNUM * _LCDTYPE;
dogcatfee 9:e2909d7f36b8 200 uint8_t lbCounter=0;
dogcatfee 9:e2909d7f36b8 201 uint8_t *lbpLCDWF;
dogcatfee 9:e2909d7f36b8 202
dogcatfee 9:e2909d7f36b8 203 lbpLCDWF = (uint8_t *)&LCD->WF8B[0];
dogcatfee 9:e2909d7f36b8 204 while (lbCounter < lbTotalBytes)
dogcatfee 9:e2909d7f36b8 205 {
dogcatfee 9:e2909d7f36b8 206 if (mode==1){lbpLCDWF[(uint8_t)WF_ORDERING_TABLE[lbCounter++]]=_ALLON;}
dogcatfee 9:e2909d7f36b8 207 else {lbpLCDWF[WF_ORDERING_TABLE[lbCounter++]]=0;}
dogcatfee 9:e2909d7f36b8 208 }
dogcatfee 9:e2909d7f36b8 209 }
dogcatfee 9:e2909d7f36b8 210
dogcatfee 9:e2909d7f36b8 211 void SLCD::DP1 (int mode)
dogcatfee 9:e2909d7f36b8 212 {
dogcatfee 9:e2909d7f36b8 213 uint8_t *lbpLCDWF;
dogcatfee 9:e2909d7f36b8 214 lbpLCDWF = (uint8_t *)&LCD->WF8B[0];
dogcatfee 9:e2909d7f36b8 215 if (mode==1){lbpLCDWF[(uint8_t)WF_ORDERING_TABLE[1]]|=1;}
dogcatfee 9:e2909d7f36b8 216 else {lbpLCDWF[(uint8_t)WF_ORDERING_TABLE[1]]&=~1;}
dogcatfee 9:e2909d7f36b8 217 }
dogcatfee 9:e2909d7f36b8 218
dogcatfee 9:e2909d7f36b8 219 void SLCD::DP2 (int mode)
dogcatfee 9:e2909d7f36b8 220 {
dogcatfee 9:e2909d7f36b8 221 uint8_t *lbpLCDWF;
dogcatfee 9:e2909d7f36b8 222 lbpLCDWF = (uint8_t *)&LCD->WF8B[0];
dogcatfee 9:e2909d7f36b8 223 if (mode==1){lbpLCDWF[(uint8_t)WF_ORDERING_TABLE[3]]|=1;}
dogcatfee 9:e2909d7f36b8 224 else {lbpLCDWF[(uint8_t)WF_ORDERING_TABLE[3]]&=~1;}
dogcatfee 9:e2909d7f36b8 225 }
dogcatfee 9:e2909d7f36b8 226
dogcatfee 9:e2909d7f36b8 227 void SLCD::DP3 (int mode)
dogcatfee 9:e2909d7f36b8 228 {
dogcatfee 9:e2909d7f36b8 229 uint8_t *lbpLCDWF;
dogcatfee 9:e2909d7f36b8 230 lbpLCDWF = (uint8_t *)&LCD->WF8B[0];
dogcatfee 9:e2909d7f36b8 231 if (mode==1){lbpLCDWF[(uint8_t)WF_ORDERING_TABLE[5]]|=1;}
dogcatfee 9:e2909d7f36b8 232 else {lbpLCDWF[(uint8_t)WF_ORDERING_TABLE[5]]&=~1;}
dogcatfee 9:e2909d7f36b8 233 }
dogcatfee 9:e2909d7f36b8 234
dogcatfee 9:e2909d7f36b8 235 void SLCD::Colon (int mode)
dogcatfee 9:e2909d7f36b8 236 {
dogcatfee 9:e2909d7f36b8 237 uint8_t *lbpLCDWF;
dogcatfee 9:e2909d7f36b8 238 lbpLCDWF = (uint8_t *)&LCD->WF8B[0];
dogcatfee 9:e2909d7f36b8 239 if (mode==1){lbpLCDWF[(uint8_t)WF_ORDERING_TABLE[7]]|=1;}
dogcatfee 9:e2909d7f36b8 240 else {lbpLCDWF[(uint8_t)WF_ORDERING_TABLE[7]]&=~1;}
dogcatfee 9:e2909d7f36b8 241 }
dogcatfee 9:e2909d7f36b8 242
dogcatfee 9:e2909d7f36b8 243
dogcatfee 9:e2909d7f36b8 244 void SLCD::clear()
dogcatfee 9:e2909d7f36b8 245 {
dogcatfee 9:e2909d7f36b8 246 All_Segments(0);
dogcatfee 9:e2909d7f36b8 247 }