V7's MotorTestProgram for F446

Dependencies:   mbed ros_lib_kinetic USBDevice

Committer:
ksingyuunyuu
Date:
Mon Apr 15 11:37:19 2019 +0000
Revision:
1:417488dfc3d0
V7's MotorTestProgram for F446

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ksingyuunyuu 1:417488dfc3d0 1 /* mbed Microcontroller Library
ksingyuunyuu 1:417488dfc3d0 2 * Copyright (c) 2006-2013 ARM Limited
ksingyuunyuu 1:417488dfc3d0 3 *
ksingyuunyuu 1:417488dfc3d0 4 * Licensed under the Apache License, Version 2.0 (the "License");
ksingyuunyuu 1:417488dfc3d0 5 * you may not use this file except in compliance with the License.
ksingyuunyuu 1:417488dfc3d0 6 * You may obtain a copy of the License at
ksingyuunyuu 1:417488dfc3d0 7 *
ksingyuunyuu 1:417488dfc3d0 8 * http://www.apache.org/licenses/LICENSE-2.0
ksingyuunyuu 1:417488dfc3d0 9 *
ksingyuunyuu 1:417488dfc3d0 10 * Unless required by applicable law or agreed to in writing, software
ksingyuunyuu 1:417488dfc3d0 11 * distributed under the License is distributed on an "AS IS" BASIS,
ksingyuunyuu 1:417488dfc3d0 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
ksingyuunyuu 1:417488dfc3d0 13 * See the License for the specific language governing permissions and
ksingyuunyuu 1:417488dfc3d0 14 * limitations under the License.
ksingyuunyuu 1:417488dfc3d0 15 */
ksingyuunyuu 1:417488dfc3d0 16 #ifndef MBED_CAN_H
ksingyuunyuu 1:417488dfc3d0 17 #define MBED_CAN_H
ksingyuunyuu 1:417488dfc3d0 18
ksingyuunyuu 1:417488dfc3d0 19 #include "platform.h"
ksingyuunyuu 1:417488dfc3d0 20
ksingyuunyuu 1:417488dfc3d0 21 #if DEVICE_CAN
ksingyuunyuu 1:417488dfc3d0 22
ksingyuunyuu 1:417488dfc3d0 23 #include "can_api.h"
ksingyuunyuu 1:417488dfc3d0 24 #include "can_helper.h"
ksingyuunyuu 1:417488dfc3d0 25 #include "FunctionPointer.h"
ksingyuunyuu 1:417488dfc3d0 26
ksingyuunyuu 1:417488dfc3d0 27 namespace mbed {
ksingyuunyuu 1:417488dfc3d0 28
ksingyuunyuu 1:417488dfc3d0 29 /** CANMessage class
ksingyuunyuu 1:417488dfc3d0 30 */
ksingyuunyuu 1:417488dfc3d0 31 class CANMessage : public CAN_Message {
ksingyuunyuu 1:417488dfc3d0 32
ksingyuunyuu 1:417488dfc3d0 33 public:
ksingyuunyuu 1:417488dfc3d0 34 /** Creates empty CAN message.
ksingyuunyuu 1:417488dfc3d0 35 */
ksingyuunyuu 1:417488dfc3d0 36 CANMessage() : CAN_Message() {
ksingyuunyuu 1:417488dfc3d0 37 len = 8;
ksingyuunyuu 1:417488dfc3d0 38 type = CANData;
ksingyuunyuu 1:417488dfc3d0 39 format = CANStandard;
ksingyuunyuu 1:417488dfc3d0 40 id = 0;
ksingyuunyuu 1:417488dfc3d0 41 memset(data, 0, 8);
ksingyuunyuu 1:417488dfc3d0 42 }
ksingyuunyuu 1:417488dfc3d0 43
ksingyuunyuu 1:417488dfc3d0 44 /** Creates CAN message with specific content.
ksingyuunyuu 1:417488dfc3d0 45 */
ksingyuunyuu 1:417488dfc3d0 46 CANMessage(int _id, const char *_data, char _len = 8, CANType _type = CANData, CANFormat _format = CANStandard) {
ksingyuunyuu 1:417488dfc3d0 47 len = _len & 0xF;
ksingyuunyuu 1:417488dfc3d0 48 type = _type;
ksingyuunyuu 1:417488dfc3d0 49 format = _format;
ksingyuunyuu 1:417488dfc3d0 50 id = _id;
ksingyuunyuu 1:417488dfc3d0 51 memcpy(data, _data, _len);
ksingyuunyuu 1:417488dfc3d0 52 }
ksingyuunyuu 1:417488dfc3d0 53
ksingyuunyuu 1:417488dfc3d0 54 /** Creates CAN remote message.
ksingyuunyuu 1:417488dfc3d0 55 */
ksingyuunyuu 1:417488dfc3d0 56 CANMessage(int _id, CANFormat _format = CANStandard) {
ksingyuunyuu 1:417488dfc3d0 57 len = 0;
ksingyuunyuu 1:417488dfc3d0 58 type = CANRemote;
ksingyuunyuu 1:417488dfc3d0 59 format = _format;
ksingyuunyuu 1:417488dfc3d0 60 id = _id;
ksingyuunyuu 1:417488dfc3d0 61 memset(data, 0, 8);
ksingyuunyuu 1:417488dfc3d0 62 }
ksingyuunyuu 1:417488dfc3d0 63 };
ksingyuunyuu 1:417488dfc3d0 64
ksingyuunyuu 1:417488dfc3d0 65 /** A can bus client, used for communicating with can devices
ksingyuunyuu 1:417488dfc3d0 66 */
ksingyuunyuu 1:417488dfc3d0 67 class CAN {
ksingyuunyuu 1:417488dfc3d0 68
ksingyuunyuu 1:417488dfc3d0 69 public:
ksingyuunyuu 1:417488dfc3d0 70 /** Creates an CAN interface connected to specific pins.
ksingyuunyuu 1:417488dfc3d0 71 *
ksingyuunyuu 1:417488dfc3d0 72 * @param rd read from transmitter
ksingyuunyuu 1:417488dfc3d0 73 * @param td transmit to transmitter
ksingyuunyuu 1:417488dfc3d0 74 *
ksingyuunyuu 1:417488dfc3d0 75 * Example:
ksingyuunyuu 1:417488dfc3d0 76 * @code
ksingyuunyuu 1:417488dfc3d0 77 * #include "mbed.h"
ksingyuunyuu 1:417488dfc3d0 78 *
ksingyuunyuu 1:417488dfc3d0 79 * Ticker ticker;
ksingyuunyuu 1:417488dfc3d0 80 * DigitalOut led1(LED1);
ksingyuunyuu 1:417488dfc3d0 81 * DigitalOut led2(LED2);
ksingyuunyuu 1:417488dfc3d0 82 * CAN can1(p9, p10);
ksingyuunyuu 1:417488dfc3d0 83 * CAN can2(p30, p29);
ksingyuunyuu 1:417488dfc3d0 84 *
ksingyuunyuu 1:417488dfc3d0 85 * char counter = 0;
ksingyuunyuu 1:417488dfc3d0 86 *
ksingyuunyuu 1:417488dfc3d0 87 * void send() {
ksingyuunyuu 1:417488dfc3d0 88 * if(can1.write(CANMessage(1337, &counter, 1))) {
ksingyuunyuu 1:417488dfc3d0 89 * printf("Message sent: %d\n", counter);
ksingyuunyuu 1:417488dfc3d0 90 * counter++;
ksingyuunyuu 1:417488dfc3d0 91 * }
ksingyuunyuu 1:417488dfc3d0 92 * led1 = !led1;
ksingyuunyuu 1:417488dfc3d0 93 * }
ksingyuunyuu 1:417488dfc3d0 94 *
ksingyuunyuu 1:417488dfc3d0 95 * int main() {
ksingyuunyuu 1:417488dfc3d0 96 * ticker.attach(&send, 1);
ksingyuunyuu 1:417488dfc3d0 97 * CANMessage msg;
ksingyuunyuu 1:417488dfc3d0 98 * while(1) {
ksingyuunyuu 1:417488dfc3d0 99 * if(can2.read(msg)) {
ksingyuunyuu 1:417488dfc3d0 100 * printf("Message received: %d\n\n", msg.data[0]);
ksingyuunyuu 1:417488dfc3d0 101 * led2 = !led2;
ksingyuunyuu 1:417488dfc3d0 102 * }
ksingyuunyuu 1:417488dfc3d0 103 * wait(0.2);
ksingyuunyuu 1:417488dfc3d0 104 * }
ksingyuunyuu 1:417488dfc3d0 105 * }
ksingyuunyuu 1:417488dfc3d0 106 * @endcode
ksingyuunyuu 1:417488dfc3d0 107 */
ksingyuunyuu 1:417488dfc3d0 108 CAN(PinName rd, PinName td);
ksingyuunyuu 1:417488dfc3d0 109 virtual ~CAN();
ksingyuunyuu 1:417488dfc3d0 110
ksingyuunyuu 1:417488dfc3d0 111 /** Set the frequency of the CAN interface
ksingyuunyuu 1:417488dfc3d0 112 *
ksingyuunyuu 1:417488dfc3d0 113 * @param hz The bus frequency in hertz
ksingyuunyuu 1:417488dfc3d0 114 *
ksingyuunyuu 1:417488dfc3d0 115 * @returns
ksingyuunyuu 1:417488dfc3d0 116 * 1 if successful,
ksingyuunyuu 1:417488dfc3d0 117 * 0 otherwise
ksingyuunyuu 1:417488dfc3d0 118 */
ksingyuunyuu 1:417488dfc3d0 119 int frequency(int hz);
ksingyuunyuu 1:417488dfc3d0 120
ksingyuunyuu 1:417488dfc3d0 121 /** Write a CANMessage to the bus.
ksingyuunyuu 1:417488dfc3d0 122 *
ksingyuunyuu 1:417488dfc3d0 123 * @param msg The CANMessage to write.
ksingyuunyuu 1:417488dfc3d0 124 *
ksingyuunyuu 1:417488dfc3d0 125 * @returns
ksingyuunyuu 1:417488dfc3d0 126 * 0 if write failed,
ksingyuunyuu 1:417488dfc3d0 127 * 1 if write was successful
ksingyuunyuu 1:417488dfc3d0 128 */
ksingyuunyuu 1:417488dfc3d0 129 int write(CANMessage msg);
ksingyuunyuu 1:417488dfc3d0 130
ksingyuunyuu 1:417488dfc3d0 131 /** Read a CANMessage from the bus.
ksingyuunyuu 1:417488dfc3d0 132 *
ksingyuunyuu 1:417488dfc3d0 133 * @param msg A CANMessage to read to.
ksingyuunyuu 1:417488dfc3d0 134 * @param handle message filter handle (0 for any message)
ksingyuunyuu 1:417488dfc3d0 135 *
ksingyuunyuu 1:417488dfc3d0 136 * @returns
ksingyuunyuu 1:417488dfc3d0 137 * 0 if no message arrived,
ksingyuunyuu 1:417488dfc3d0 138 * 1 if message arrived
ksingyuunyuu 1:417488dfc3d0 139 */
ksingyuunyuu 1:417488dfc3d0 140 int read(CANMessage &msg, int handle = 0);
ksingyuunyuu 1:417488dfc3d0 141
ksingyuunyuu 1:417488dfc3d0 142 /** Reset CAN interface.
ksingyuunyuu 1:417488dfc3d0 143 *
ksingyuunyuu 1:417488dfc3d0 144 * To use after error overflow.
ksingyuunyuu 1:417488dfc3d0 145 */
ksingyuunyuu 1:417488dfc3d0 146 void reset();
ksingyuunyuu 1:417488dfc3d0 147
ksingyuunyuu 1:417488dfc3d0 148 /** Puts or removes the CAN interface into silent monitoring mode
ksingyuunyuu 1:417488dfc3d0 149 *
ksingyuunyuu 1:417488dfc3d0 150 * @param silent boolean indicating whether to go into silent mode or not
ksingyuunyuu 1:417488dfc3d0 151 */
ksingyuunyuu 1:417488dfc3d0 152 void monitor(bool silent);
ksingyuunyuu 1:417488dfc3d0 153
ksingyuunyuu 1:417488dfc3d0 154 enum Mode {
ksingyuunyuu 1:417488dfc3d0 155 Reset = 0,
ksingyuunyuu 1:417488dfc3d0 156 Normal,
ksingyuunyuu 1:417488dfc3d0 157 Silent,
ksingyuunyuu 1:417488dfc3d0 158 LocalTest,
ksingyuunyuu 1:417488dfc3d0 159 GlobalTest,
ksingyuunyuu 1:417488dfc3d0 160 SilentTest
ksingyuunyuu 1:417488dfc3d0 161 };
ksingyuunyuu 1:417488dfc3d0 162
ksingyuunyuu 1:417488dfc3d0 163 /** Change CAN operation to the specified mode
ksingyuunyuu 1:417488dfc3d0 164 *
ksingyuunyuu 1:417488dfc3d0 165 * @param mode The new operation mode (CAN::Normal, CAN::Silent, CAN::LocalTest, CAN::GlobalTest, CAN::SilentTest)
ksingyuunyuu 1:417488dfc3d0 166 *
ksingyuunyuu 1:417488dfc3d0 167 * @returns
ksingyuunyuu 1:417488dfc3d0 168 * 0 if mode change failed or unsupported,
ksingyuunyuu 1:417488dfc3d0 169 * 1 if mode change was successful
ksingyuunyuu 1:417488dfc3d0 170 */
ksingyuunyuu 1:417488dfc3d0 171 int mode(Mode mode);
ksingyuunyuu 1:417488dfc3d0 172
ksingyuunyuu 1:417488dfc3d0 173 /** Filter out incomming messages
ksingyuunyuu 1:417488dfc3d0 174 *
ksingyuunyuu 1:417488dfc3d0 175 * @param id the id to filter on
ksingyuunyuu 1:417488dfc3d0 176 * @param mask the mask applied to the id
ksingyuunyuu 1:417488dfc3d0 177 * @param format format to filter on (Default CANAny)
ksingyuunyuu 1:417488dfc3d0 178 * @param handle message filter handle (Optional)
ksingyuunyuu 1:417488dfc3d0 179 *
ksingyuunyuu 1:417488dfc3d0 180 * @returns
ksingyuunyuu 1:417488dfc3d0 181 * 0 if filter change failed or unsupported,
ksingyuunyuu 1:417488dfc3d0 182 * new filter handle if successful
ksingyuunyuu 1:417488dfc3d0 183 */
ksingyuunyuu 1:417488dfc3d0 184 int filter(unsigned int id, unsigned int mask, CANFormat format = CANAny, int handle = 0);
ksingyuunyuu 1:417488dfc3d0 185
ksingyuunyuu 1:417488dfc3d0 186 /** Returns number of read errors to detect read overflow errors.
ksingyuunyuu 1:417488dfc3d0 187 */
ksingyuunyuu 1:417488dfc3d0 188 unsigned char rderror();
ksingyuunyuu 1:417488dfc3d0 189
ksingyuunyuu 1:417488dfc3d0 190 /** Returns number of write errors to detect write overflow errors.
ksingyuunyuu 1:417488dfc3d0 191 */
ksingyuunyuu 1:417488dfc3d0 192 unsigned char tderror();
ksingyuunyuu 1:417488dfc3d0 193
ksingyuunyuu 1:417488dfc3d0 194 enum IrqType {
ksingyuunyuu 1:417488dfc3d0 195 RxIrq = 0,
ksingyuunyuu 1:417488dfc3d0 196 TxIrq,
ksingyuunyuu 1:417488dfc3d0 197 EwIrq,
ksingyuunyuu 1:417488dfc3d0 198 DoIrq,
ksingyuunyuu 1:417488dfc3d0 199 WuIrq,
ksingyuunyuu 1:417488dfc3d0 200 EpIrq,
ksingyuunyuu 1:417488dfc3d0 201 AlIrq,
ksingyuunyuu 1:417488dfc3d0 202 BeIrq,
ksingyuunyuu 1:417488dfc3d0 203 IdIrq
ksingyuunyuu 1:417488dfc3d0 204 };
ksingyuunyuu 1:417488dfc3d0 205
ksingyuunyuu 1:417488dfc3d0 206 /** Attach a function to call whenever a CAN frame received interrupt is
ksingyuunyuu 1:417488dfc3d0 207 * generated.
ksingyuunyuu 1:417488dfc3d0 208 *
ksingyuunyuu 1:417488dfc3d0 209 * @param fptr A pointer to a void function, or 0 to set as none
ksingyuunyuu 1:417488dfc3d0 210 * @param event Which CAN interrupt to attach the member function to (CAN::RxIrq for message received, CAN::TxIrq for transmitted or aborted, CAN::EwIrq for error warning, CAN::DoIrq for data overrun, CAN::WuIrq for wake-up, CAN::EpIrq for error passive, CAN::AlIrq for arbitration lost, CAN::BeIrq for bus error)
ksingyuunyuu 1:417488dfc3d0 211 */
ksingyuunyuu 1:417488dfc3d0 212 void attach(void (*fptr)(void), IrqType type=RxIrq);
ksingyuunyuu 1:417488dfc3d0 213
ksingyuunyuu 1:417488dfc3d0 214 /** Attach a member function to call whenever a CAN frame received interrupt
ksingyuunyuu 1:417488dfc3d0 215 * is generated.
ksingyuunyuu 1:417488dfc3d0 216 *
ksingyuunyuu 1:417488dfc3d0 217 * @param tptr pointer to the object to call the member function on
ksingyuunyuu 1:417488dfc3d0 218 * @param mptr pointer to the member function to be called
ksingyuunyuu 1:417488dfc3d0 219 * @param event Which CAN interrupt to attach the member function to (CAN::RxIrq for message received, TxIrq for transmitted or aborted, EwIrq for error warning, DoIrq for data overrun, WuIrq for wake-up, EpIrq for error passive, AlIrq for arbitration lost, BeIrq for bus error)
ksingyuunyuu 1:417488dfc3d0 220 */
ksingyuunyuu 1:417488dfc3d0 221 template<typename T>
ksingyuunyuu 1:417488dfc3d0 222 void attach(T* tptr, void (T::*mptr)(void), IrqType type=RxIrq) {
ksingyuunyuu 1:417488dfc3d0 223 if((mptr != NULL) && (tptr != NULL)) {
ksingyuunyuu 1:417488dfc3d0 224 _irq[type].attach(tptr, mptr);
ksingyuunyuu 1:417488dfc3d0 225 can_irq_set(&_can, (CanIrqType)type, 1);
ksingyuunyuu 1:417488dfc3d0 226 }
ksingyuunyuu 1:417488dfc3d0 227 else {
ksingyuunyuu 1:417488dfc3d0 228 can_irq_set(&_can, (CanIrqType)type, 0);
ksingyuunyuu 1:417488dfc3d0 229 }
ksingyuunyuu 1:417488dfc3d0 230 }
ksingyuunyuu 1:417488dfc3d0 231
ksingyuunyuu 1:417488dfc3d0 232 static void _irq_handler(uint32_t id, CanIrqType type);
ksingyuunyuu 1:417488dfc3d0 233
ksingyuunyuu 1:417488dfc3d0 234 protected:
ksingyuunyuu 1:417488dfc3d0 235 can_t _can;
ksingyuunyuu 1:417488dfc3d0 236 FunctionPointer _irq[9];
ksingyuunyuu 1:417488dfc3d0 237 };
ksingyuunyuu 1:417488dfc3d0 238
ksingyuunyuu 1:417488dfc3d0 239 } // namespace mbed
ksingyuunyuu 1:417488dfc3d0 240
ksingyuunyuu 1:417488dfc3d0 241 #endif
ksingyuunyuu 1:417488dfc3d0 242
ksingyuunyuu 1:417488dfc3d0 243 #endif // MBED_CAN_H
ksingyuunyuu 1:417488dfc3d0 244